fjes: net_device_ops.ndo_open and .ndo_stop
authorTaku Izumi <izumi.taku@jp.fujitsu.com>
Fri, 21 Aug 2015 08:29:23 +0000 (17:29 +0900)
committerDavid S. Miller <davem@davemloft.net>
Mon, 24 Aug 2015 21:06:34 +0000 (14:06 -0700)
This patch adds net_device_ops.ndo_open and .ndo_stop
callback. These function is called when network device
activation and deactivation.

Signed-off-by: Taku Izumi <izumi.taku@jp.fujitsu.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/fjes/fjes.h
drivers/net/fjes/fjes_hw.c
drivers/net/fjes/fjes_hw.h
drivers/net/fjes/fjes_main.c
drivers/net/fjes/fjes_regs.h

index 54bc189a997c1cb84f4eb9b7066f82f927f8d6a9..f182ed3a4cd12234604c4bf33be1450b65c5b1fc 100644 (file)
@@ -29,6 +29,7 @@
 #define FJES_ACPI_SYMBOL       "Extended Socket"
 #define FJES_MAX_QUEUES                1
 #define FJES_TX_RETRY_INTERVAL (20 * HZ)
+#define FJES_OPEN_ZONE_UPDATE_WAIT     (300) /* msec */
 
 /* board specific private data structure */
 struct fjes_adapter {
index 1e807dfc548afa2fb42f9db3832a235fa195a78c..1935f48e9e43a912c6b25117b832e0263ab6c9e4 100644 (file)
@@ -638,6 +638,25 @@ int fjes_hw_unregister_buff_addr(struct fjes_hw *hw, int dest_epid)
        return result;
 }
 
+int fjes_hw_raise_interrupt(struct fjes_hw *hw, int dest_epid,
+                           enum REG_ICTL_MASK  mask)
+{
+       u32 ig = mask | dest_epid;
+
+       wr32(XSCT_IG, cpu_to_le32(ig));
+
+       return 0;
+}
+
+u32 fjes_hw_capture_interrupt_status(struct fjes_hw *hw)
+{
+       u32 cur_is;
+
+       cur_is = rd32(XSCT_IS);
+
+       return cur_is;
+}
+
 void fjes_hw_set_irqmask(struct fjes_hw *hw,
                         enum REG_ICTL_MASK intr_mask, bool mask)
 {
@@ -646,3 +665,129 @@ void fjes_hw_set_irqmask(struct fjes_hw *hw,
        else
                wr32(XSCT_IMC, intr_mask);
 }
+
+bool fjes_hw_epid_is_same_zone(struct fjes_hw *hw, int epid)
+{
+       if (epid >= hw->max_epid)
+               return false;
+
+       if ((hw->ep_shm_info[epid].es_status !=
+                       FJES_ZONING_STATUS_ENABLE) ||
+               (hw->ep_shm_info[hw->my_epid].zone ==
+                       FJES_ZONING_ZONE_TYPE_NONE))
+               return false;
+       else
+               return (hw->ep_shm_info[epid].zone ==
+                               hw->ep_shm_info[hw->my_epid].zone);
+}
+
+int fjes_hw_epid_is_shared(struct fjes_device_shared_info *share,
+                          int dest_epid)
+{
+       int value = false;
+
+       if (dest_epid < share->epnum)
+               value = share->ep_status[dest_epid];
+
+       return value;
+}
+
+static bool fjes_hw_epid_is_stop_requested(struct fjes_hw *hw, int src_epid)
+{
+       return test_bit(src_epid, &hw->txrx_stop_req_bit);
+}
+
+static bool fjes_hw_epid_is_stop_process_done(struct fjes_hw *hw, int src_epid)
+{
+       return (hw->ep_shm_info[src_epid].tx.info->v1i.rx_status &
+                       FJES_RX_STOP_REQ_DONE);
+}
+
+enum ep_partner_status
+fjes_hw_get_partner_ep_status(struct fjes_hw *hw, int epid)
+{
+       enum ep_partner_status status;
+
+       if (fjes_hw_epid_is_shared(hw->hw_info.share, epid)) {
+               if (fjes_hw_epid_is_stop_requested(hw, epid)) {
+                       status = EP_PARTNER_WAITING;
+               } else {
+                       if (fjes_hw_epid_is_stop_process_done(hw, epid))
+                               status = EP_PARTNER_COMPLETE;
+                       else
+                               status = EP_PARTNER_SHARED;
+               }
+       } else {
+               status = EP_PARTNER_UNSHARE;
+       }
+
+       return status;
+}
+
+void fjes_hw_raise_epstop(struct fjes_hw *hw)
+{
+       enum ep_partner_status status;
+       int epidx;
+
+       for (epidx = 0; epidx < hw->max_epid; epidx++) {
+               if (epidx == hw->my_epid)
+                       continue;
+
+               status = fjes_hw_get_partner_ep_status(hw, epidx);
+               switch (status) {
+               case EP_PARTNER_SHARED:
+                       fjes_hw_raise_interrupt(hw, epidx,
+                                               REG_ICTL_MASK_TXRX_STOP_REQ);
+                       break;
+               default:
+                       break;
+               }
+
+               set_bit(epidx, &hw->hw_info.buffer_unshare_reserve_bit);
+               set_bit(epidx, &hw->txrx_stop_req_bit);
+
+               hw->ep_shm_info[epidx].tx.info->v1i.rx_status |=
+                               FJES_RX_STOP_REQ_REQUEST;
+       }
+}
+
+int fjes_hw_wait_epstop(struct fjes_hw *hw)
+{
+       enum ep_partner_status status;
+       union ep_buffer_info *info;
+       int wait_time = 0;
+       int epidx;
+
+       while (hw->hw_info.buffer_unshare_reserve_bit &&
+              (wait_time < FJES_COMMAND_EPSTOP_WAIT_TIMEOUT * 1000)) {
+               for (epidx = 0; epidx < hw->max_epid; epidx++) {
+                       if (epidx == hw->my_epid)
+                               continue;
+                       status = fjes_hw_epid_is_shared(hw->hw_info.share,
+                                                       epidx);
+                       info = hw->ep_shm_info[epidx].rx.info;
+                       if ((!status ||
+                            (info->v1i.rx_status &
+                             FJES_RX_STOP_REQ_DONE)) &&
+                           test_bit(epidx,
+                                    &hw->hw_info.buffer_unshare_reserve_bit)) {
+                               clear_bit(epidx,
+                                         &hw->hw_info.buffer_unshare_reserve_bit);
+                       }
+               }
+
+               msleep(100);
+               wait_time += 100;
+       }
+
+       for (epidx = 0; epidx < hw->max_epid; epidx++) {
+               if (epidx == hw->my_epid)
+                       continue;
+               if (test_bit(epidx, &hw->hw_info.buffer_unshare_reserve_bit))
+                       clear_bit(epidx,
+                                 &hw->hw_info.buffer_unshare_reserve_bit);
+       }
+
+       return (wait_time < FJES_COMMAND_EPSTOP_WAIT_TIMEOUT * 1000)
+                       ? 0 : -EBUSY;
+}
index 2e750e9655ef3d037e5168a2e3a00fdedde114d4..9b8df553f730d35dd53c2318ef64c3ad74e029bc 100644 (file)
@@ -36,6 +36,7 @@ struct fjes_hw;
 #define FJES_DEVICE_RESET_TIMEOUT  ((17 + 1) * 3) /* sec */
 #define FJES_COMMAND_REQ_TIMEOUT  (5 + 1) /* sec */
 #define FJES_COMMAND_REQ_BUFF_TIMEOUT  (8 * 3) /* sec */
+#define FJES_COMMAND_EPSTOP_WAIT_TIMEOUT       (1) /* sec */
 
 #define FJES_CMD_REQ_ERR_INFO_PARAM  (0x0001)
 #define FJES_CMD_REQ_ERR_INFO_STATUS (0x0002)
@@ -43,6 +44,17 @@ struct fjes_hw;
 #define FJES_CMD_REQ_RES_CODE_NORMAL (0)
 #define FJES_CMD_REQ_RES_CODE_BUSY   (1)
 
+#define FJES_ZONING_STATUS_DISABLE     (0x00)
+#define FJES_ZONING_STATUS_ENABLE      (0x01)
+#define FJES_ZONING_STATUS_INVALID     (0xFF)
+
+#define FJES_ZONING_ZONE_TYPE_NONE (0xFF)
+
+#define FJES_RX_STOP_REQ_NONE          (0x0)
+#define FJES_RX_STOP_REQ_DONE          (0x1)
+#define FJES_RX_STOP_REQ_REQUEST       (0x2)
+#define FJES_RX_POLL_WORK              (0x4)
+
 #define EP_BUFFER_SIZE \
        (((sizeof(union ep_buffer_info) + (128 * (64 * 1024))) \
                / EP_BUFFER_INFO_SIZE) * EP_BUFFER_INFO_SIZE)
@@ -77,6 +89,15 @@ struct esmem_frame {
        u8 frame_data[];
 };
 
+/* EP partner status */
+enum ep_partner_status {
+       EP_PARTNER_UNSHARE,
+       EP_PARTNER_SHARED,
+       EP_PARTNER_WAITING,
+       EP_PARTNER_COMPLETE,
+       EP_PARTNER_STATUS_MAX,
+};
+
 /* shared status region */
 struct fjes_device_shared_info {
        int epnum;
@@ -278,6 +299,15 @@ int fjes_hw_unregister_buff_addr(struct fjes_hw *, int);
 void fjes_hw_init_command_registers(struct fjes_hw *,
                                    struct fjes_device_command_param *);
 void fjes_hw_setup_epbuf(struct epbuf_handler *, u8 *, u32);
+int fjes_hw_raise_interrupt(struct fjes_hw *, int, enum REG_ICTL_MASK);
 void fjes_hw_set_irqmask(struct fjes_hw *, enum REG_ICTL_MASK, bool);
+u32 fjes_hw_capture_interrupt_status(struct fjes_hw *);
+void fjes_hw_raise_epstop(struct fjes_hw *);
+int fjes_hw_wait_epstop(struct fjes_hw *);
+enum ep_partner_status
+       fjes_hw_get_partner_ep_status(struct fjes_hw *, int);
+
+bool fjes_hw_epid_is_same_zone(struct fjes_hw *, int);
+int fjes_hw_epid_is_shared(struct fjes_device_shared_info *, int);
 
 #endif /* FJES_HW_H_ */
index 45a8b9c52ae5296a9854760d13826faf2ac241da..bd50cbd6915fcf029a24436e960427881a6ac7e3 100644 (file)
@@ -24,6 +24,7 @@
 #include <linux/nls.h>
 #include <linux/platform_device.h>
 #include <linux/netdevice.h>
+#include <linux/interrupt.h>
 
 #include "fjes.h"
 
@@ -43,6 +44,15 @@ MODULE_DESCRIPTION("FUJITSU Extended Socket Network Device Driver");
 MODULE_LICENSE("GPL");
 MODULE_VERSION(DRV_VERSION);
 
+static int fjes_request_irq(struct fjes_adapter *);
+static void fjes_free_irq(struct fjes_adapter *);
+
+static int fjes_open(struct net_device *);
+static int fjes_close(struct net_device *);
+static int fjes_setup_resources(struct fjes_adapter *);
+static void fjes_free_resources(struct fjes_adapter *);
+static irqreturn_t fjes_intr(int, void*);
+
 static int fjes_acpi_add(struct acpi_device *);
 static int fjes_acpi_remove(struct acpi_device *);
 static acpi_status fjes_get_acpi_resource(struct acpi_resource *, void*);
@@ -170,9 +180,245 @@ fjes_get_acpi_resource(struct acpi_resource *acpi_res, void *data)
        return AE_OK;
 }
 
+static int fjes_request_irq(struct fjes_adapter *adapter)
+{
+       struct net_device *netdev = adapter->netdev;
+       int result = -1;
+
+       if (!adapter->irq_registered) {
+               result = request_irq(adapter->hw.hw_res.irq, fjes_intr,
+                                    IRQF_SHARED, netdev->name, adapter);
+               if (result)
+                       adapter->irq_registered = false;
+               else
+                       adapter->irq_registered = true;
+       }
+
+       return result;
+}
+
+static void fjes_free_irq(struct fjes_adapter *adapter)
+{
+       struct fjes_hw *hw = &adapter->hw;
+
+       fjes_hw_set_irqmask(hw, REG_ICTL_MASK_ALL, true);
+
+       if (adapter->irq_registered) {
+               free_irq(adapter->hw.hw_res.irq, adapter);
+               adapter->irq_registered = false;
+       }
+}
+
 static const struct net_device_ops fjes_netdev_ops = {
+       .ndo_open               = fjes_open,
+       .ndo_stop               = fjes_close,
 };
 
+/* fjes_open - Called when a network interface is made active */
+static int fjes_open(struct net_device *netdev)
+{
+       struct fjes_adapter *adapter = netdev_priv(netdev);
+       struct fjes_hw *hw = &adapter->hw;
+       int result;
+
+       if (adapter->open_guard)
+               return -ENXIO;
+
+       result = fjes_setup_resources(adapter);
+       if (result)
+               goto err_setup_res;
+
+       hw->txrx_stop_req_bit = 0;
+       hw->epstop_req_bit = 0;
+
+       fjes_hw_capture_interrupt_status(hw);
+
+       result = fjes_request_irq(adapter);
+       if (result)
+               goto err_req_irq;
+
+       fjes_hw_set_irqmask(hw, REG_ICTL_MASK_ALL, false);
+
+       netif_tx_start_all_queues(netdev);
+       netif_carrier_on(netdev);
+
+       return 0;
+
+err_req_irq:
+       fjes_free_irq(adapter);
+
+err_setup_res:
+       fjes_free_resources(adapter);
+       return result;
+}
+
+/* fjes_close - Disables a network interface */
+static int fjes_close(struct net_device *netdev)
+{
+       struct fjes_adapter *adapter = netdev_priv(netdev);
+       struct fjes_hw *hw = &adapter->hw;
+       int epidx;
+
+       netif_tx_stop_all_queues(netdev);
+       netif_carrier_off(netdev);
+
+       fjes_hw_raise_epstop(hw);
+
+       for (epidx = 0; epidx < hw->max_epid; epidx++) {
+               if (epidx == hw->my_epid)
+                       continue;
+
+               adapter->hw.ep_shm_info[epidx].tx.info->v1i.rx_status &=
+                       ~FJES_RX_POLL_WORK;
+       }
+
+       fjes_free_irq(adapter);
+
+       fjes_hw_wait_epstop(hw);
+
+       fjes_free_resources(adapter);
+
+       return 0;
+}
+
+static int fjes_setup_resources(struct fjes_adapter *adapter)
+{
+       struct net_device *netdev = adapter->netdev;
+       struct ep_share_mem_info *buf_pair;
+       struct fjes_hw *hw = &adapter->hw;
+       int result;
+       int epidx;
+
+       mutex_lock(&hw->hw_info.lock);
+       result = fjes_hw_request_info(hw);
+       switch (result) {
+       case 0:
+               for (epidx = 0; epidx < hw->max_epid; epidx++) {
+                       hw->ep_shm_info[epidx].es_status =
+                           hw->hw_info.res_buf->info.info[epidx].es_status;
+                       hw->ep_shm_info[epidx].zone =
+                           hw->hw_info.res_buf->info.info[epidx].zone;
+               }
+               break;
+       default:
+       case -ENOMSG:
+       case -EBUSY:
+               adapter->force_reset = true;
+
+               mutex_unlock(&hw->hw_info.lock);
+               return result;
+       }
+       mutex_unlock(&hw->hw_info.lock);
+
+       for (epidx = 0; epidx < (hw->max_epid); epidx++) {
+               if ((epidx != hw->my_epid) &&
+                   (hw->ep_shm_info[epidx].es_status ==
+                    FJES_ZONING_STATUS_ENABLE)) {
+                       fjes_hw_raise_interrupt(hw, epidx,
+                                               REG_ICTL_MASK_INFO_UPDATE);
+               }
+       }
+
+       msleep(FJES_OPEN_ZONE_UPDATE_WAIT * hw->max_epid);
+
+       for (epidx = 0; epidx < (hw->max_epid); epidx++) {
+               if (epidx == hw->my_epid)
+                       continue;
+
+               buf_pair = &hw->ep_shm_info[epidx];
+
+               fjes_hw_setup_epbuf(&buf_pair->tx, netdev->dev_addr,
+                                   netdev->mtu);
+
+               if (fjes_hw_epid_is_same_zone(hw, epidx)) {
+                       mutex_lock(&hw->hw_info.lock);
+                       result =
+                       fjes_hw_register_buff_addr(hw, epidx, buf_pair);
+                       mutex_unlock(&hw->hw_info.lock);
+
+                       switch (result) {
+                       case 0:
+                               break;
+                       case -ENOMSG:
+                       case -EBUSY:
+                       default:
+                               adapter->force_reset = true;
+                               return result;
+                       }
+               }
+       }
+
+       return 0;
+}
+
+static void fjes_free_resources(struct fjes_adapter *adapter)
+{
+       struct net_device *netdev = adapter->netdev;
+       struct fjes_device_command_param param;
+       struct ep_share_mem_info *buf_pair;
+       struct fjes_hw *hw = &adapter->hw;
+       bool reset_flag = false;
+       int result;
+       int epidx;
+
+       for (epidx = 0; epidx < hw->max_epid; epidx++) {
+               if (epidx == hw->my_epid)
+                       continue;
+
+               mutex_lock(&hw->hw_info.lock);
+               result = fjes_hw_unregister_buff_addr(hw, epidx);
+               mutex_unlock(&hw->hw_info.lock);
+
+               if (result)
+                       reset_flag = true;
+
+               buf_pair = &hw->ep_shm_info[epidx];
+
+               fjes_hw_setup_epbuf(&buf_pair->tx,
+                                   netdev->dev_addr, netdev->mtu);
+
+               clear_bit(epidx, &hw->txrx_stop_req_bit);
+       }
+
+       if (reset_flag || adapter->force_reset) {
+               result = fjes_hw_reset(hw);
+
+               adapter->force_reset = false;
+
+               if (result)
+                       adapter->open_guard = true;
+
+               hw->hw_info.buffer_share_bit = 0;
+
+               memset((void *)&param, 0, sizeof(param));
+
+               param.req_len = hw->hw_info.req_buf_size;
+               param.req_start = __pa(hw->hw_info.req_buf);
+               param.res_len = hw->hw_info.res_buf_size;
+               param.res_start = __pa(hw->hw_info.res_buf);
+               param.share_start = __pa(hw->hw_info.share->ep_status);
+
+               fjes_hw_init_command_registers(hw, &param);
+       }
+}
+
+static irqreturn_t fjes_intr(int irq, void *data)
+{
+       struct fjes_adapter *adapter = data;
+       struct fjes_hw *hw = &adapter->hw;
+       irqreturn_t ret;
+       u32 icr;
+
+       icr = fjes_hw_capture_interrupt_status(hw);
+
+       if (icr & REG_IS_MASK_IS_ASSERT)
+               ret = IRQ_HANDLED;
+       else
+               ret = IRQ_NONE;
+
+       return ret;
+}
+
 /* fjes_probe - Device Initialization Routine */
 static int fjes_probe(struct platform_device *plat_dev)
 {
index cc975a0fd111ad437f6d23f8e08e46997bdf9f46..029c924dc175580c88bc6b0ba0f51b999b688f20 100644 (file)
 #define XSCT_RESPBAH        0x004C  /* Response Buffer Address High */
 
 /* Interrupt Control registers */
+#define XSCT_IS             0x0080  /* Interrupt status */
 #define XSCT_IMS            0x0084  /* Interrupt mask set */
 #define XSCT_IMC            0x0088  /* Interrupt mask clear */
+#define XSCT_IG             0x008C  /* Interrupt generator */
+#define XSCT_ICTL           0x0090  /* Interrupt control */
 
 /* register structure */
 /* Information registers */
@@ -101,6 +104,15 @@ union REG_CS {
        __le32 reg;
 };
 
+/* Interrupt Control registers */
+union REG_ICTL {
+       struct {
+               __le32 automak:1;
+               __le32 rsv0:31;
+       } bits;
+       __le32 reg;
+};
+
 enum REG_ICTL_MASK {
        REG_ICTL_MASK_INFO_UPDATE     = 1 << 20,
        REG_ICTL_MASK_DEV_STOP_REQ    = 1 << 19,
@@ -110,6 +122,11 @@ enum REG_ICTL_MASK {
        REG_ICTL_MASK_ALL             = GENMASK(20, 16),
 };
 
+enum REG_IS_MASK {
+       REG_IS_MASK_IS_ASSERT   = 1 << 31,
+       REG_IS_MASK_EPID        = GENMASK(15, 0),
+};
+
 struct fjes_hw;
 
 u32 fjes_hw_rd32(struct fjes_hw *hw, u32 reg);