|
142 | 142 | #define FLEXCAN_TX_MB_RESERVED_OFF_FIFO 8
|
143 | 143 | #define FLEXCAN_TX_MB_RESERVED_OFF_TIMESTAMP 0
|
144 | 144 | #define FLEXCAN_RX_MB_OFF_TIMESTAMP_FIRST (FLEXCAN_TX_MB_RESERVED_OFF_TIMESTAMP + 1)
|
| 145 | +#define FLEXCAN_IFLAG_MB(x) BIT_ULL(x) |
145 | 146 | #define FLEXCAN_IFLAG2_MB(x) BIT((x) & 0x1f)
|
146 | 147 | #define FLEXCAN_IFLAG_RX_FIFO_OVERFLOW BIT(7)
|
147 | 148 | #define FLEXCAN_IFLAG_RX_FIFO_WARN BIT(6)
|
@@ -277,9 +278,8 @@ struct flexcan_priv {
|
277 | 278 | u8 mb_size;
|
278 | 279 | u8 clk_src; /* clock source of CAN Protocol Engine */
|
279 | 280 |
|
| 281 | + u64 rx_mask; |
280 | 282 | u32 reg_ctrl_default;
|
281 |
| - u32 rx_mask1; |
282 |
| - u32 rx_mask2; |
283 | 283 |
|
284 | 284 | struct clk *clk_ipg;
|
285 | 285 | struct clk *clk_per;
|
@@ -872,16 +872,15 @@ static struct sk_buff *flexcan_mailbox_read(struct can_rx_offload *offload,
|
872 | 872 | return skb;
|
873 | 873 | }
|
874 | 874 |
|
875 |
| - |
876 | 875 | static inline u64 flexcan_read_reg_iflag_rx(struct flexcan_priv *priv)
|
877 | 876 | {
|
878 | 877 | struct flexcan_regs __iomem *regs = priv->regs;
|
879 |
| - u32 iflag1, iflag2; |
| 878 | + u64 iflag; |
880 | 879 |
|
881 |
| - iflag2 = priv->read(®s->iflag2) & priv->rx_mask2; |
882 |
| - iflag1 = priv->read(®s->iflag1) & priv->rx_mask1; |
| 880 | + iflag = (u64)priv->read(®s->iflag2) << 32 | |
| 881 | + priv->read(®s->iflag1); |
883 | 882 |
|
884 |
| - return (u64)iflag2 << 32 | iflag1; |
| 883 | + return iflag & priv->rx_mask; |
885 | 884 | }
|
886 | 885 |
|
887 | 886 | static irqreturn_t flexcan_irq(int irq, void *dev_id)
|
@@ -1052,6 +1051,7 @@ static int flexcan_chip_start(struct net_device *dev)
|
1052 | 1051 | struct flexcan_priv *priv = netdev_priv(dev);
|
1053 | 1052 | struct flexcan_regs __iomem *regs = priv->regs;
|
1054 | 1053 | u32 reg_mcr, reg_ctrl, reg_ctrl2, reg_mecr;
|
| 1054 | + u64 reg_imask; |
1055 | 1055 | int err, i;
|
1056 | 1056 | struct flexcan_mb __iomem *mb;
|
1057 | 1057 |
|
@@ -1226,8 +1226,9 @@ static int flexcan_chip_start(struct net_device *dev)
|
1226 | 1226 | /* enable interrupts atomically */
|
1227 | 1227 | disable_irq(dev->irq);
|
1228 | 1228 | priv->write(priv->reg_ctrl_default, ®s->ctrl);
|
1229 |
| - priv->write(priv->rx_mask1, ®s->imask1); |
1230 |
| - priv->write(priv->rx_mask2 | FLEXCAN_IFLAG2_MB(priv->tx_mb_idx), ®s->imask2); |
| 1229 | + reg_imask = priv->rx_mask | FLEXCAN_IFLAG_MB(priv->tx_mb_idx); |
| 1230 | + priv->write(upper_32_bits(reg_imask), ®s->imask2); |
| 1231 | + priv->write(lower_32_bits(reg_imask), ®s->imask1); |
1231 | 1232 | enable_irq(dev->irq);
|
1232 | 1233 |
|
1233 | 1234 | /* print chip status */
|
@@ -1299,19 +1300,14 @@ static int flexcan_open(struct net_device *dev)
|
1299 | 1300 | priv->offload.mailbox_read = flexcan_mailbox_read;
|
1300 | 1301 |
|
1301 | 1302 | if (priv->devtype_data->quirks & FLEXCAN_QUIRK_USE_OFF_TIMESTAMP) {
|
1302 |
| - u64 imask; |
1303 |
| - |
1304 | 1303 | priv->offload.mb_first = FLEXCAN_RX_MB_OFF_TIMESTAMP_FIRST;
|
1305 | 1304 | priv->offload.mb_last = priv->mb_count - 2;
|
1306 | 1305 |
|
1307 |
| - imask = GENMASK_ULL(priv->offload.mb_last, |
1308 |
| - priv->offload.mb_first); |
1309 |
| - priv->rx_mask1 = imask; |
1310 |
| - priv->rx_mask2 = imask >> 32; |
1311 |
| - |
| 1306 | + priv->rx_mask = GENMASK_ULL(priv->offload.mb_last, |
| 1307 | + priv->offload.mb_first); |
1312 | 1308 | err = can_rx_offload_add_timestamp(dev, &priv->offload);
|
1313 | 1309 | } else {
|
1314 |
| - priv->rx_mask1 = FLEXCAN_IFLAG_RX_FIFO_OVERFLOW | |
| 1310 | + priv->rx_mask = FLEXCAN_IFLAG_RX_FIFO_OVERFLOW | |
1315 | 1311 | FLEXCAN_IFLAG_RX_FIFO_AVAILABLE;
|
1316 | 1312 | err = can_rx_offload_add_fifo(dev, &priv->offload,
|
1317 | 1313 | FLEXCAN_NAPI_WEIGHT);
|
|
0 commit comments