driver: net: ethernet: cpsw: make cpts as pointer
As CPTS is common module for both EMAC in Dual EMAC mode so making cpts as pointer. Signed-off-by: Mugunthan V N <mugunthanvnm@ti.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
committed by
David S. Miller
parent
f6e135c81e
commit
9232b16df2
@@ -319,7 +319,7 @@ struct cpsw_priv {
|
|||||||
/* snapshot of IRQ numbers */
|
/* snapshot of IRQ numbers */
|
||||||
u32 irqs_table[4];
|
u32 irqs_table[4];
|
||||||
u32 num_irqs;
|
u32 num_irqs;
|
||||||
struct cpts cpts;
|
struct cpts *cpts;
|
||||||
};
|
};
|
||||||
|
|
||||||
#define napi_to_priv(napi) container_of(napi, struct cpsw_priv, napi)
|
#define napi_to_priv(napi) container_of(napi, struct cpsw_priv, napi)
|
||||||
@@ -383,7 +383,7 @@ void cpsw_tx_handler(void *token, int len, int status)
|
|||||||
*/
|
*/
|
||||||
if (unlikely(netif_queue_stopped(ndev)))
|
if (unlikely(netif_queue_stopped(ndev)))
|
||||||
netif_start_queue(ndev);
|
netif_start_queue(ndev);
|
||||||
cpts_tx_timestamp(&priv->cpts, skb);
|
cpts_tx_timestamp(priv->cpts, skb);
|
||||||
priv->stats.tx_packets++;
|
priv->stats.tx_packets++;
|
||||||
priv->stats.tx_bytes += len;
|
priv->stats.tx_bytes += len;
|
||||||
dev_kfree_skb_any(skb);
|
dev_kfree_skb_any(skb);
|
||||||
@@ -404,7 +404,7 @@ void cpsw_rx_handler(void *token, int len, int status)
|
|||||||
}
|
}
|
||||||
if (likely(status >= 0)) {
|
if (likely(status >= 0)) {
|
||||||
skb_put(skb, len);
|
skb_put(skb, len);
|
||||||
cpts_rx_timestamp(&priv->cpts, skb);
|
cpts_rx_timestamp(priv->cpts, skb);
|
||||||
skb->protocol = eth_type_trans(skb, ndev);
|
skb->protocol = eth_type_trans(skb, ndev);
|
||||||
netif_receive_skb(skb);
|
netif_receive_skb(skb);
|
||||||
priv->stats.rx_bytes += len;
|
priv->stats.rx_bytes += len;
|
||||||
@@ -760,7 +760,8 @@ static netdev_tx_t cpsw_ndo_start_xmit(struct sk_buff *skb,
|
|||||||
return NETDEV_TX_OK;
|
return NETDEV_TX_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP && priv->cpts.tx_enable)
|
if (skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP &&
|
||||||
|
priv->cpts->tx_enable)
|
||||||
skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
|
skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
|
||||||
|
|
||||||
skb_tx_timestamp(skb);
|
skb_tx_timestamp(skb);
|
||||||
@@ -815,7 +816,7 @@ static void cpsw_hwtstamp_v1(struct cpsw_priv *priv)
|
|||||||
struct cpsw_slave *slave = &priv->slaves[priv->data.cpts_active_slave];
|
struct cpsw_slave *slave = &priv->slaves[priv->data.cpts_active_slave];
|
||||||
u32 ts_en, seq_id;
|
u32 ts_en, seq_id;
|
||||||
|
|
||||||
if (!priv->cpts.tx_enable && !priv->cpts.rx_enable) {
|
if (!priv->cpts->tx_enable && !priv->cpts->rx_enable) {
|
||||||
slave_write(slave, 0, CPSW1_TS_CTL);
|
slave_write(slave, 0, CPSW1_TS_CTL);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@@ -823,10 +824,10 @@ static void cpsw_hwtstamp_v1(struct cpsw_priv *priv)
|
|||||||
seq_id = (30 << CPSW_V1_SEQ_ID_OFS_SHIFT) | ETH_P_1588;
|
seq_id = (30 << CPSW_V1_SEQ_ID_OFS_SHIFT) | ETH_P_1588;
|
||||||
ts_en = EVENT_MSG_BITS << CPSW_V1_MSG_TYPE_OFS;
|
ts_en = EVENT_MSG_BITS << CPSW_V1_MSG_TYPE_OFS;
|
||||||
|
|
||||||
if (priv->cpts.tx_enable)
|
if (priv->cpts->tx_enable)
|
||||||
ts_en |= CPSW_V1_TS_TX_EN;
|
ts_en |= CPSW_V1_TS_TX_EN;
|
||||||
|
|
||||||
if (priv->cpts.rx_enable)
|
if (priv->cpts->rx_enable)
|
||||||
ts_en |= CPSW_V1_TS_RX_EN;
|
ts_en |= CPSW_V1_TS_RX_EN;
|
||||||
|
|
||||||
slave_write(slave, ts_en, CPSW1_TS_CTL);
|
slave_write(slave, ts_en, CPSW1_TS_CTL);
|
||||||
@@ -841,10 +842,10 @@ static void cpsw_hwtstamp_v2(struct cpsw_priv *priv)
|
|||||||
ctrl = slave_read(slave, CPSW2_CONTROL);
|
ctrl = slave_read(slave, CPSW2_CONTROL);
|
||||||
ctrl &= ~CTRL_ALL_TS_MASK;
|
ctrl &= ~CTRL_ALL_TS_MASK;
|
||||||
|
|
||||||
if (priv->cpts.tx_enable)
|
if (priv->cpts->tx_enable)
|
||||||
ctrl |= CTRL_TX_TS_BITS;
|
ctrl |= CTRL_TX_TS_BITS;
|
||||||
|
|
||||||
if (priv->cpts.rx_enable)
|
if (priv->cpts->rx_enable)
|
||||||
ctrl |= CTRL_RX_TS_BITS;
|
ctrl |= CTRL_RX_TS_BITS;
|
||||||
|
|
||||||
mtype = (30 << TS_SEQ_ID_OFFSET_SHIFT) | EVENT_MSG_BITS;
|
mtype = (30 << TS_SEQ_ID_OFFSET_SHIFT) | EVENT_MSG_BITS;
|
||||||
@@ -857,7 +858,7 @@ static void cpsw_hwtstamp_v2(struct cpsw_priv *priv)
|
|||||||
static int cpsw_hwtstamp_ioctl(struct net_device *dev, struct ifreq *ifr)
|
static int cpsw_hwtstamp_ioctl(struct net_device *dev, struct ifreq *ifr)
|
||||||
{
|
{
|
||||||
struct cpsw_priv *priv = netdev_priv(dev);
|
struct cpsw_priv *priv = netdev_priv(dev);
|
||||||
struct cpts *cpts = &priv->cpts;
|
struct cpts *cpts = priv->cpts;
|
||||||
struct hwtstamp_config cfg;
|
struct hwtstamp_config cfg;
|
||||||
|
|
||||||
if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg)))
|
if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg)))
|
||||||
@@ -1086,7 +1087,7 @@ static int cpsw_get_ts_info(struct net_device *ndev,
|
|||||||
SOF_TIMESTAMPING_RX_SOFTWARE |
|
SOF_TIMESTAMPING_RX_SOFTWARE |
|
||||||
SOF_TIMESTAMPING_SOFTWARE |
|
SOF_TIMESTAMPING_SOFTWARE |
|
||||||
SOF_TIMESTAMPING_RAW_HARDWARE;
|
SOF_TIMESTAMPING_RAW_HARDWARE;
|
||||||
info->phc_index = priv->cpts.phc_index;
|
info->phc_index = priv->cpts->phc_index;
|
||||||
info->tx_types =
|
info->tx_types =
|
||||||
(1 << HWTSTAMP_TX_OFF) |
|
(1 << HWTSTAMP_TX_OFF) |
|
||||||
(1 << HWTSTAMP_TX_ON);
|
(1 << HWTSTAMP_TX_ON);
|
||||||
@@ -1272,6 +1273,11 @@ static int cpsw_probe(struct platform_device *pdev)
|
|||||||
priv->dev = &ndev->dev;
|
priv->dev = &ndev->dev;
|
||||||
priv->msg_enable = netif_msg_init(debug_level, CPSW_DEBUG);
|
priv->msg_enable = netif_msg_init(debug_level, CPSW_DEBUG);
|
||||||
priv->rx_packet_max = max(rx_packet_max, 128);
|
priv->rx_packet_max = max(rx_packet_max, 128);
|
||||||
|
priv->cpts = devm_kzalloc(&pdev->dev, sizeof(struct cpts), GFP_KERNEL);
|
||||||
|
if (!ndev) {
|
||||||
|
pr_err("error allocating cpts\n");
|
||||||
|
goto clean_ndev_ret;
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* This may be required here for child devices.
|
* This may be required here for child devices.
|
||||||
@@ -1358,7 +1364,7 @@ static int cpsw_probe(struct platform_device *pdev)
|
|||||||
switch (priv->version) {
|
switch (priv->version) {
|
||||||
case CPSW_VERSION_1:
|
case CPSW_VERSION_1:
|
||||||
priv->host_port_regs = ss_regs + CPSW1_HOST_PORT_OFFSET;
|
priv->host_port_regs = ss_regs + CPSW1_HOST_PORT_OFFSET;
|
||||||
priv->cpts.reg = ss_regs + CPSW1_CPTS_OFFSET;
|
priv->cpts->reg = ss_regs + CPSW1_CPTS_OFFSET;
|
||||||
dma_params.dmaregs = ss_regs + CPSW1_CPDMA_OFFSET;
|
dma_params.dmaregs = ss_regs + CPSW1_CPDMA_OFFSET;
|
||||||
dma_params.txhdp = ss_regs + CPSW1_STATERAM_OFFSET;
|
dma_params.txhdp = ss_regs + CPSW1_STATERAM_OFFSET;
|
||||||
ale_params.ale_regs = ss_regs + CPSW1_ALE_OFFSET;
|
ale_params.ale_regs = ss_regs + CPSW1_ALE_OFFSET;
|
||||||
@@ -1369,7 +1375,7 @@ static int cpsw_probe(struct platform_device *pdev)
|
|||||||
break;
|
break;
|
||||||
case CPSW_VERSION_2:
|
case CPSW_VERSION_2:
|
||||||
priv->host_port_regs = ss_regs + CPSW2_HOST_PORT_OFFSET;
|
priv->host_port_regs = ss_regs + CPSW2_HOST_PORT_OFFSET;
|
||||||
priv->cpts.reg = ss_regs + CPSW2_CPTS_OFFSET;
|
priv->cpts->reg = ss_regs + CPSW2_CPTS_OFFSET;
|
||||||
dma_params.dmaregs = ss_regs + CPSW2_CPDMA_OFFSET;
|
dma_params.dmaregs = ss_regs + CPSW2_CPDMA_OFFSET;
|
||||||
dma_params.txhdp = ss_regs + CPSW2_STATERAM_OFFSET;
|
dma_params.txhdp = ss_regs + CPSW2_STATERAM_OFFSET;
|
||||||
ale_params.ale_regs = ss_regs + CPSW2_ALE_OFFSET;
|
ale_params.ale_regs = ss_regs + CPSW2_ALE_OFFSET;
|
||||||
@@ -1471,7 +1477,7 @@ static int cpsw_probe(struct platform_device *pdev)
|
|||||||
goto clean_irq_ret;
|
goto clean_irq_ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (cpts_register(&pdev->dev, &priv->cpts,
|
if (cpts_register(&pdev->dev, priv->cpts,
|
||||||
data->cpts_clock_mult, data->cpts_clock_shift))
|
data->cpts_clock_mult, data->cpts_clock_shift))
|
||||||
dev_err(priv->dev, "error registering cpts device\n");
|
dev_err(priv->dev, "error registering cpts device\n");
|
||||||
|
|
||||||
@@ -1516,7 +1522,7 @@ static int cpsw_remove(struct platform_device *pdev)
|
|||||||
pr_info("removing device");
|
pr_info("removing device");
|
||||||
platform_set_drvdata(pdev, NULL);
|
platform_set_drvdata(pdev, NULL);
|
||||||
|
|
||||||
cpts_unregister(&priv->cpts);
|
cpts_unregister(priv->cpts);
|
||||||
free_irq(ndev->irq, priv);
|
free_irq(ndev->irq, priv);
|
||||||
cpsw_ale_destroy(priv->ale);
|
cpsw_ale_destroy(priv->ale);
|
||||||
cpdma_chan_destroy(priv->txch);
|
cpdma_chan_destroy(priv->txch);
|
||||||
|
Reference in New Issue
Block a user