Refactor code; - Format code - Rename variables and macros - Remove intermediate variables - Add/remove blank lines - Reduce scope of variables - Add helper functions
Unified · Split
| @@ -70,7 +70,7 @@ MODULE_DESCRIPTION("CAN driver for Kvaser CAN/PCIe devices"); · 69 unmodified lines | ||
| 70 | 70 | #define KVASER_PCIEFD_KCAN_CMD_REG 0x400 |
| 71 | 71 | #define KVASER_PCIEFD_KCAN_IEN_REG 0x408 |
| 72 | 72 | #define KVASER_PCIEFD_KCAN_IRQ_REG 0x410 |
| 73 | −#define KVASER_PCIEFD_KCAN_TX_NPACKETS_REG 0x414 | |
| 73 | +#define KVASER_PCIEFD_KCAN_TX_NR_PACKETS_REG 0x414 | |
| 74 | 74 | #define KVASER_PCIEFD_KCAN_STAT_REG 0x418 |
| 75 | 75 | #define KVASER_PCIEFD_KCAN_MODE_REG 0x41c |
| 76 | 76 | #define KVASER_PCIEFD_KCAN_BTRN_REG 0x420 |
| @@ -124,6 +124,8 @@ MODULE_DESCRIPTION("CAN driver for Kvaser CAN/PCIe devices"); · 47 unmodified lines | ||
| 124 | 124 | |
| 125 | 125 | /* Command sequence number */ |
| 126 | 126 | #define KVASER_PCIEFD_KCAN_CMD_SEQ_MASK GENMASK(23, 16) |
| 127 | +/* Command bits */ | |
| 128 | +#define KVASER_PCIEFD_KCAN_CMD_MASK GENMASK(5, 0) | |
| 127 | 129 | /* Abort, flush and reset */ |
| 128 | 130 | #define KVASER_PCIEFD_KCAN_CMD_AT BIT(1) |
| 129 | 131 | /* Request status packet */ |
| @@ -172,9 +174,9 @@ MODULE_DESCRIPTION("CAN driver for Kvaser CAN/PCIe devices"); · 42 unmodified lines | ||
| 172 | 174 | /* Abort request */ |
| 173 | 175 | #define KVASER_PCIEFD_KCAN_STAT_AR BIT(7) |
| 174 | 176 | /* Controller is bus off */ |
| 175 | −#define KVASER_PCIEFD_KCAN_STAT_BUS_OFF_MSK (KVASER_PCIEFD_KCAN_STAT_AR | \ | |
| 176 | − KVASER_PCIEFD_KCAN_STAT_BOFF | KVASER_PCIEFD_KCAN_STAT_RMR | \ | |
| 177 | − KVASER_PCIEFD_KCAN_STAT_IRM) | |
| 177 | +#define KVASER_PCIEFD_KCAN_STAT_BUS_OFF_MASK \ | |
| 178 | + (KVASER_PCIEFD_KCAN_STAT_AR | KVASER_PCIEFD_KCAN_STAT_BOFF | \ | |
| 179 | + KVASER_PCIEFD_KCAN_STAT_RMR | KVASER_PCIEFD_KCAN_STAT_IRM) | |
| 178 | 180 | |
| 179 | 181 | /* Classic CAN mode */ |
| 180 | 182 | #define KVASER_PCIEFD_KCAN_MODE_CCM BIT(31) |
| @@ -202,15 +204,15 @@ MODULE_DESCRIPTION("CAN driver for Kvaser CAN/PCIe devices"); · 21 unmodified lines | ||
| 202 | 204 | #define KVASER_PCIEFD_KCAN_PWM_TRIGGER_MASK GENMASK(7, 0) |
| 203 | 205 | |
| 204 | 206 | /* KCAN packet type IDs */ |
| 205 | −#define KVASER_PCIEFD_PACK_TYPE_DATA 0 | |
| 206 | −#define KVASER_PCIEFD_PACK_TYPE_ACK 1 | |
| 207 | −#define KVASER_PCIEFD_PACK_TYPE_TXRQ 2 | |
| 208 | −#define KVASER_PCIEFD_PACK_TYPE_ERROR 3 | |
| 209 | −#define KVASER_PCIEFD_PACK_TYPE_EFLUSH_ACK 4 | |
| 210 | −#define KVASER_PCIEFD_PACK_TYPE_EFRAME_ACK 5 | |
| 211 | −#define KVASER_PCIEFD_PACK_TYPE_ACK_DATA 6 | |
| 212 | −#define KVASER_PCIEFD_PACK_TYPE_STATUS 8 | |
| 213 | −#define KVASER_PCIEFD_PACK_TYPE_BUS_LOAD 9 | |
| 207 | +#define KVASER_PCIEFD_PACK_TYPE_DATA 0x0 | |
| 208 | +#define KVASER_PCIEFD_PACK_TYPE_ACK 0x1 | |
| 209 | +#define KVASER_PCIEFD_PACK_TYPE_TXRQ 0x2 | |
| 210 | +#define KVASER_PCIEFD_PACK_TYPE_ERROR 0x3 | |
| 211 | +#define KVASER_PCIEFD_PACK_TYPE_EFLUSH_ACK 0x4 | |
| 212 | +#define KVASER_PCIEFD_PACK_TYPE_EFRAME_ACK 0x5 | |
| 213 | +#define KVASER_PCIEFD_PACK_TYPE_ACK_DATA 0x6 | |
| 214 | +#define KVASER_PCIEFD_PACK_TYPE_STATUS 0x8 | |
| 215 | +#define KVASER_PCIEFD_PACK_TYPE_BUS_LOAD 0x9 | |
| 214 | 216 | |
| 215 | 217 | /* Common KCAN packet definitions, second word */ |
| 216 | 218 | #define KVASER_PCIEFD_PACKET_TYPE_MASK GENMASK(31, 28) |
| @@ -322,13 +324,21 @@ static struct pci_device_id kvaser_pciefd_id_table[] = { · 105 unmodified lines | ||
| 322 | 324 | }; |
| 323 | 325 | MODULE_DEVICE_TABLE(pci, kvaser_pciefd_id_table); |
| 324 | 326 | |
| 325 | −static void kvaser_pciefd_request_status(struct kvaser_pciefd_can *can) | |
| 327 | +static inline void kvaser_pciefd_send_kcan_cmd(struct kvaser_pciefd_can *can, u32 cmd) | |
| 326 | 328 | { |
| 327 | − u32 cmd; | |
| 329 | + iowrite32(FIELD_PREP(KVASER_PCIEFD_KCAN_CMD_MASK, cmd) | | |
| 330 | + FIELD_PREP(KVASER_PCIEFD_KCAN_CMD_SEQ_MASK, ++can->cmd_seq), | |
| 331 | + can->reg_base + KVASER_PCIEFD_KCAN_CMD_REG); | |
| 332 | +} | |
| 333 | + | |
| 334 | +static inline void kvaser_pciefd_request_status(struct kvaser_pciefd_can *can) | |
| 335 | +{ | |
| 336 | + kvaser_pciefd_send_kcan_cmd(can, KVASER_PCIEFD_KCAN_CMD_SRQ); | |
| 337 | +} | |
| 328 | 338 | |
| 329 | − cmd = KVASER_PCIEFD_KCAN_CMD_SRQ; | |
| 330 | − cmd |= FIELD_PREP(KVASER_PCIEFD_KCAN_CMD_SEQ_MASK, ++can->cmd_seq); | |
| 331 | − iowrite32(cmd, can->reg_base + KVASER_PCIEFD_KCAN_CMD_REG); | |
| 339 | +static inline void kvaser_pciefd_abort_flush_reset(struct kvaser_pciefd_can *can) | |
| 340 | +{ | |
| 341 | + kvaser_pciefd_send_kcan_cmd(can, KVASER_PCIEFD_KCAN_CMD_AT); | |
| 332 | 342 | } |
| 333 | 343 | |
| 334 | 344 | static void kvaser_pciefd_enable_err_gen(struct kvaser_pciefd_can *can) |
| @@ -383,7 +393,6 @@ static void kvaser_pciefd_setup_controller(struct kvaser_pciefd_can *can) · 48 unmodified lines | ||
| 383 | 393 | unsigned long irq; |
| 384 | 394 | |
| 385 | 395 | spin_lock_irqsave(&can->lock, irq); |
| 386 | − | |
| 387 | 396 | mode = ioread32(can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG); |
| 388 | 397 | if (can->can.ctrlmode & CAN_CTRLMODE_FD) { |
| 389 | 398 | mode &= ~KVASER_PCIEFD_KCAN_MODE_CCM; |
| @@ -400,7 +409,6 @@ static void kvaser_pciefd_setup_controller(struct kvaser_pciefd_can *can) · 10 unmodified lines | ||
| 400 | 409 | mode |= KVASER_PCIEFD_KCAN_MODE_LOM; |
| 401 | 410 | else |
| 402 | 411 | mode &= ~KVASER_PCIEFD_KCAN_MODE_LOM; |
| 403 | − | |
| 404 | 412 | mode |= KVASER_PCIEFD_KCAN_MODE_EEN; |
| 405 | 413 | mode |= KVASER_PCIEFD_KCAN_MODE_EPEN; |
| 406 | 414 | /* Use ACK packet type */ |
| @@ -417,18 +425,13 @@ static void kvaser_pciefd_start_controller_flush(struct kvaser_pciefd_can *can) · 10 unmodified lines | ||
| 417 | 425 | unsigned long irq; |
| 418 | 426 | |
| 419 | 427 | spin_lock_irqsave(&can->lock, irq); |
| 420 | − iowrite32(-1, can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 428 | + iowrite32(GENMASK(31, 0), can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 421 | 429 | iowrite32(KVASER_PCIEFD_KCAN_IRQ_ABD, |
| 422 | 430 | can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); |
| 423 | − | |
| 424 | 431 | status = ioread32(can->reg_base + KVASER_PCIEFD_KCAN_STAT_REG); |
| 425 | 432 | if (status & KVASER_PCIEFD_KCAN_STAT_IDLE) { |
| 426 | − u32 cmd; | |
| 427 | − | |
| 428 | 433 | /* If controller is already idle, run abort, flush and reset */ |
| 429 | − cmd = KVASER_PCIEFD_KCAN_CMD_AT; | |
| 430 | − cmd |= FIELD_PREP(KVASER_PCIEFD_KCAN_CMD_SEQ_MASK, ++can->cmd_seq); | |
| 431 | − iowrite32(cmd, can->reg_base + KVASER_PCIEFD_KCAN_CMD_REG); | |
| 434 | + kvaser_pciefd_abort_flush_reset(can); | |
| 432 | 435 | } else if (!(status & KVASER_PCIEFD_KCAN_STAT_RMR)) { |
| 433 | 436 | u32 mode; |
| 434 | 437 | |
| @@ -437,7 +440,6 @@ static void kvaser_pciefd_start_controller_flush(struct kvaser_pciefd_can *can) · 2 unmodified lines | ||
| 437 | 440 | mode |= KVASER_PCIEFD_KCAN_MODE_RM; |
| 438 | 441 | iowrite32(mode, can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG); |
| 439 | 442 | } |
| 440 | − | |
| 441 | 443 | spin_unlock_irqrestore(&can->lock, irq); |
| 442 | 444 | } |
| 443 | 445 | |
| @@ -447,7 +449,6 @@ static int kvaser_pciefd_bus_on(struct kvaser_pciefd_can *can) · 3 unmodified lines | ||
| 447 | 449 | unsigned long irq; |
| 448 | 450 | |
| 449 | 451 | del_timer(&can->bec_poll_timer); |
| 450 | − | |
| 451 | 452 | if (!completion_done(&can->flush_comp)) |
| 452 | 453 | kvaser_pciefd_start_controller_flush(can); |
| 453 | 454 | |
| @@ -459,11 +460,9 @@ static int kvaser_pciefd_bus_on(struct kvaser_pciefd_can *can) · 5 unmodified lines | ||
| 459 | 460 | |
| 460 | 461 | spin_lock_irqsave(&can->lock, irq); |
| 461 | 462 | iowrite32(0, can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); |
| 462 | − iowrite32(-1, can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 463 | − | |
| 463 | + iowrite32(GENMASK(31, 0), can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 464 | 464 | iowrite32(KVASER_PCIEFD_KCAN_IRQ_ABD, |
| 465 | 465 | can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); |
| 466 | − | |
| 467 | 466 | mode = ioread32(can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG); |
| 468 | 467 | mode &= ~KVASER_PCIEFD_KCAN_MODE_RM; |
| 469 | 468 | iowrite32(mode, can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG); |
| @@ -476,11 +475,10 @@ static int kvaser_pciefd_bus_on(struct kvaser_pciefd_can *can) · 6 unmodified lines | ||
| 476 | 475 | } |
| 477 | 476 | /* Reset interrupt handling */ |
| 478 | 477 | iowrite32(0, can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); |
| 479 | − iowrite32(-1, can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 478 | + iowrite32(GENMASK(31, 0), can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 480 | 479 | |
| 481 | 480 | kvaser_pciefd_set_tx_irq(can); |
| 482 | 481 | kvaser_pciefd_setup_controller(can); |
| 483 | − | |
| 484 | 482 | can->can.state = CAN_STATE_ERROR_ACTIVE; |
| 485 | 483 | netif_wake_queue(can->can.dev); |
| 486 | 484 | can->bec.txerr = 0; |
| @@ -499,7 +497,6 @@ static void kvaser_pciefd_pwm_stop(struct kvaser_pciefd_can *can) · 12 unmodified lines | ||
| 499 | 497 | spin_lock_irqsave(&can->lock, irq); |
| 500 | 498 | pwm_ctrl = ioread32(can->reg_base + KVASER_PCIEFD_KCAN_PWM_REG); |
| 501 | 499 | top = FIELD_GET(KVASER_PCIEFD_KCAN_PWM_TOP_MASK, pwm_ctrl); |
| 502 | − | |
| 503 | 500 | /* Set duty cycle to zero */ |
| 504 | 501 | pwm_ctrl |= FIELD_PREP(KVASER_PCIEFD_KCAN_PWM_TRIGGER_MASK, top); |
| 505 | 502 | iowrite32(pwm_ctrl, can->reg_base + KVASER_PCIEFD_KCAN_PWM_REG); |
| @@ -514,8 +511,7 @@ static void kvaser_pciefd_pwm_start(struct kvaser_pciefd_can *can) · 8 unmodified lines | ||
| 514 | 511 | |
| 515 | 512 | kvaser_pciefd_pwm_stop(can); |
| 516 | 513 | spin_lock_irqsave(&can->lock, irq); |
| 517 | − | |
| 518 | − /* Set frequency to 500 KHz*/ | |
| 514 | + /* Set frequency to 500 KHz */ | |
| 519 | 515 | top = can->kv_pcie->bus_freq / (2 * 500000) - 1; |
| 520 | 516 | |
| 521 | 517 | pwm_ctrl = FIELD_PREP(KVASER_PCIEFD_KCAN_PWM_TRIGGER_MASK, top); |
| @@ -580,7 +576,6 @@ static int kvaser_pciefd_prepare_tx_packet(struct kvaser_pciefd_tx_packet *p, · 58 unmodified lines | ||
| 580 | 576 | int seq = can->echo_idx; |
| 581 | 577 | |
| 582 | 578 | memset(p, 0, sizeof(*p)); |
| 583 | − | |
| 584 | 579 | if (can->can.ctrlmode & CAN_CTRLMODE_ONE_SHOT) |
| 585 | 580 | p->header[1] |= KVASER_PCIEFD_TPACKET_SMS; |
| 586 | 581 | |
| @@ -621,16 +616,15 @@ static netdev_tx_t kvaser_pciefd_start_xmit(struct sk_buff *skb, · 34 unmodified lines | ||
| 621 | 616 | struct kvaser_pciefd_can *can = netdev_priv(netdev); |
| 622 | 617 | unsigned long irq_flags; |
| 623 | 618 | struct kvaser_pciefd_tx_packet packet; |
| 624 | − int nwords; | |
| 619 | + int nr_words; | |
| 625 | 620 | u8 count; |
| 626 | 621 | |
| 627 | 622 | if (can_dev_dropped_skb(netdev, skb)) |
| 628 | 623 | return NETDEV_TX_OK; |
| 629 | 624 | |
| 630 | − nwords = kvaser_pciefd_prepare_tx_packet(&packet, can, skb); | |
| 625 | + nr_words = kvaser_pciefd_prepare_tx_packet(&packet, can, skb); | |
| 631 | 626 | |
| 632 | 627 | spin_lock_irqsave(&can->echo_lock, irq_flags); |
| 633 | − | |
| 634 | 628 | /* Prepare and save echo skb in internal slot */ |
| 635 | 629 | can_put_echo_skb(skb, netdev, can->echo_idx, 0); |
| 636 | 630 | |
| @@ -643,13 +637,13 @@ static netdev_tx_t kvaser_pciefd_start_xmit(struct sk_buff *skb, · 6 unmodified lines | ||
| 643 | 637 | iowrite32(packet.header[1], |
| 644 | 638 | can->reg_base + KVASER_PCIEFD_KCAN_FIFO_REG); |
| 645 | 639 | |
| 646 | − if (nwords) { | |
| 647 | − u32 data_last = ((u32 *)packet.data)[nwords - 1]; | |
| 640 | + if (nr_words) { | |
| 641 | + u32 data_last = ((u32 *)packet.data)[nr_words - 1]; | |
| 648 | 642 | |
| 649 | 643 | /* Write data to fifo, except last word */ |
| 650 | 644 | iowrite32_rep(can->reg_base + |
| 651 | 645 | KVASER_PCIEFD_KCAN_FIFO_REG, packet.data, |
| 652 | − nwords - 1); | |
| 646 | + nr_words - 1); | |
| 653 | 647 | /* Write last word to end of fifo */ |
| 654 | 648 | __raw_writel(data_last, can->reg_base + |
| 655 | 649 | KVASER_PCIEFD_KCAN_FIFO_LAST_REG); |
| @@ -660,14 +654,13 @@ static netdev_tx_t kvaser_pciefd_start_xmit(struct sk_buff *skb, · 4 unmodified lines | ||
| 660 | 654 | } |
| 661 | 655 | |
| 662 | 656 | count = FIELD_GET(KVASER_PCIEFD_KCAN_TX_NR_PACKETS_CURRENT_MASK, |
| 663 | − ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NPACKETS_REG)); | |
| 657 | + ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NR_PACKETS_REG)); | |
| 664 | 658 | /* No room for a new message, stop the queue until at least one |
| 665 | 659 | * successful transmit |
| 666 | 660 | */ |
| 667 | 661 | if (count >= KVASER_PCIEFD_CAN_TX_MAX_COUNT || |
| 668 | 662 | can->can.echo_skb[can->echo_idx]) |
| 669 | 663 | netif_stop_queue(netdev); |
| 670 | − | |
| 671 | 664 | spin_unlock_irqrestore(&can->echo_lock, irq_flags); |
| 672 | 665 | |
| 673 | 666 | return NETDEV_TX_OK; |
| @@ -692,16 +685,13 @@ static int kvaser_pciefd_set_bittiming(struct kvaser_pciefd_can *can, bool data) · 18 unmodified lines | ||
| 692 | 685 | |
| 693 | 686 | spin_lock_irqsave(&can->lock, irq_flags); |
| 694 | 687 | mode = ioread32(can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG); |
| 695 | − | |
| 696 | 688 | /* Put the circuit in reset mode */ |
| 697 | 689 | iowrite32(mode | KVASER_PCIEFD_KCAN_MODE_RM, |
| 698 | 690 | can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG); |
| 699 | 691 | |
| 700 | 692 | /* Can only set bittiming if in reset mode */ |
| 701 | 693 | ret = readl_poll_timeout(can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG, |
| 702 | − test, test & KVASER_PCIEFD_KCAN_MODE_RM, | |
| 703 | − 0, 10); | |
| 704 | − | |
| 694 | + test, test & KVASER_PCIEFD_KCAN_MODE_RM, 0, 10); | |
| 705 | 695 | if (ret) { |
| 706 | 696 | spin_unlock_irqrestore(&can->lock, irq_flags); |
| 707 | 697 | return -EBUSY; |
| @@ -711,11 +701,10 @@ static int kvaser_pciefd_set_bittiming(struct kvaser_pciefd_can *can, bool data) · 3 unmodified lines | ||
| 711 | 701 | iowrite32(btrn, can->reg_base + KVASER_PCIEFD_KCAN_BTRD_REG); |
| 712 | 702 | else |
| 713 | 703 | iowrite32(btrn, can->reg_base + KVASER_PCIEFD_KCAN_BTRN_REG); |
| 714 | − | |
| 715 | 704 | /* Restore previous reset mode status */ |
| 716 | 705 | iowrite32(mode, can->reg_base + KVASER_PCIEFD_KCAN_MODE_REG); |
| 717 | − | |
| 718 | 706 | spin_unlock_irqrestore(&can->lock, irq_flags); |
| 707 | + | |
| 719 | 708 | return 0; |
| 720 | 709 | } |
| 721 | 710 | |
| @@ -753,6 +742,7 @@ static int kvaser_pciefd_get_berr_counter(const struct net_device *ndev, · 31 unmodified lines | ||
| 753 | 742 | |
| 754 | 743 | bec->rxerr = can->bec.rxerr; |
| 755 | 744 | bec->txerr = can->bec.txerr; |
| 745 | + | |
| 756 | 746 | return 0; |
| 757 | 747 | } |
| 758 | 748 | |
| @@ -796,7 +786,6 @@ static int kvaser_pciefd_setup_can_ctrls(struct kvaser_pciefd *pcie) · 37 unmodified lines | ||
| 796 | 786 | netdev->ethtool_ops = &kvaser_pciefd_ethtool_ops; |
| 797 | 787 | can->reg_base = pcie->reg_base + KVASER_PCIEFD_KCAN0_BASE + |
| 798 | 788 | i * KVASER_PCIEFD_KCAN_BASE_OFFSET; |
| 799 | − | |
| 800 | 789 | can->kv_pcie = pcie; |
| 801 | 790 | can->cmd_seq = 0; |
| 802 | 791 | can->err_rep_cnt = 0; |
| @@ -805,15 +794,14 @@ static int kvaser_pciefd_setup_can_ctrls(struct kvaser_pciefd *pcie) · 2 unmodified lines | ||
| 805 | 794 | |
| 806 | 795 | init_completion(&can->start_comp); |
| 807 | 796 | init_completion(&can->flush_comp); |
| 808 | − timer_setup(&can->bec_poll_timer, kvaser_pciefd_bec_poll_timer, | |
| 809 | − 0); | |
| 797 | + timer_setup(&can->bec_poll_timer, kvaser_pciefd_bec_poll_timer, 0); | |
| 810 | 798 | |
| 811 | 799 | /* Disable Bus load reporting */ |
| 812 | 800 | iowrite32(0, can->reg_base + KVASER_PCIEFD_KCAN_BUS_LOAD_REG); |
| 813 | 801 | |
| 814 | 802 | tx_nr_packets_max = |
| 815 | 803 | FIELD_GET(KVASER_PCIEFD_KCAN_TX_NR_PACKETS_MAX_MASK, |
| 816 | − ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NPACKETS_REG)); | |
| 804 | + ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NR_PACKETS_REG)); | |
| 817 | 805 | if (tx_nr_packets_max < KVASER_PCIEFD_CAN_TX_MAX_COUNT) { |
| 818 | 806 | dev_err(&pcie->pci->dev, |
| 819 | 807 | "Max Tx count is smaller than expected\n"); |
| @@ -827,16 +815,13 @@ static int kvaser_pciefd_setup_can_ctrls(struct kvaser_pciefd *pcie) · 7 unmodified lines | ||
| 827 | 815 | can->echo_idx = 0; |
| 828 | 816 | spin_lock_init(&can->echo_lock); |
| 829 | 817 | spin_lock_init(&can->lock); |
| 818 | + | |
| 830 | 819 | can->can.bittiming_const = &kvaser_pciefd_bittiming_const; |
| 831 | 820 | can->can.data_bittiming_const = &kvaser_pciefd_bittiming_const; |
| 832 | − | |
| 833 | 821 | can->can.do_set_bittiming = kvaser_pciefd_set_nominal_bittiming; |
| 834 | − can->can.do_set_data_bittiming = | |
| 835 | − kvaser_pciefd_set_data_bittiming; | |
| 836 | − | |
| 822 | + can->can.do_set_data_bittiming = kvaser_pciefd_set_data_bittiming; | |
| 837 | 823 | can->can.do_set_mode = kvaser_pciefd_set_mode; |
| 838 | 824 | can->can.do_get_berr_counter = kvaser_pciefd_get_berr_counter; |
| 839 | − | |
| 840 | 825 | can->can.ctrlmode_supported = CAN_CTRLMODE_LISTENONLY | |
| 841 | 826 | CAN_CTRLMODE_FD | |
| 842 | 827 | CAN_CTRLMODE_FD_NON_ISO | |
| @@ -855,10 +840,9 @@ static int kvaser_pciefd_setup_can_ctrls(struct kvaser_pciefd *pcie) · 12 unmodified lines | ||
| 855 | 840 | can->can.ctrlmode_supported |= CAN_CTRLMODE_ONE_SHOT; |
| 856 | 841 | |
| 857 | 842 | netdev->flags |= IFF_ECHO; |
| 858 | − | |
| 859 | 843 | SET_NETDEV_DEV(netdev, &pcie->pci->dev); |
| 860 | 844 | |
| 861 | − iowrite32(-1, can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 845 | + iowrite32(GENMASK(31, 0), can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); | |
| 862 | 846 | iowrite32(KVASER_PCIEFD_KCAN_IRQ_ABD, |
| 863 | 847 | can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); |
| 864 | 848 | |
| @@ -917,18 +901,16 @@ static int kvaser_pciefd_setup_dma(struct kvaser_pciefd *pcie) · 52 unmodified lines | ||
| 917 | 901 | for (i = 0; i < KVASER_PCIEFD_DMA_COUNT; i++) { |
| 918 | 902 | unsigned int offset = KVASER_PCIEFD_DMA_MAP_BASE + 8 * i; |
| 919 | 903 | |
| 920 | − pcie->dma_data[i] = | |
| 921 | − dmam_alloc_coherent(&pcie->pci->dev, | |
| 922 | − KVASER_PCIEFD_DMA_SIZE, | |
| 923 | − &dma_addr[i], | |
| 924 | − GFP_KERNEL); | |
| 904 | + pcie->dma_data[i] = dmam_alloc_coherent(&pcie->pci->dev, | |
| 905 | + KVASER_PCIEFD_DMA_SIZE, | |
| 906 | + &dma_addr[i], | |
| 907 | + GFP_KERNEL); | |
| 925 | 908 | |
| 926 | 909 | if (!pcie->dma_data[i] || !dma_addr[i]) { |
| 927 | 910 | dev_err(&pcie->pci->dev, "Rx dma_alloc(%u) failure\n", |
| 928 | 911 | KVASER_PCIEFD_DMA_SIZE); |
| 929 | 912 | return -ENOMEM; |
| 930 | 913 | } |
| 931 | − | |
| 932 | 914 | kvaser_pciefd_write_dma_map(pcie, dma_addr[i], offset); |
| 933 | 915 | } |
| 934 | 916 | |
| @@ -936,7 +918,6 @@ static int kvaser_pciefd_setup_dma(struct kvaser_pciefd *pcie) · 1 unmodified line | ||
| 936 | 918 | iowrite32(KVASER_PCIEFD_SRB_CMD_FOR | KVASER_PCIEFD_SRB_CMD_RDB0 | |
| 937 | 919 | KVASER_PCIEFD_SRB_CMD_RDB1, |
| 938 | 920 | pcie->reg_base + KVASER_PCIEFD_SRB_CMD_REG); |
| 939 | − | |
| 940 | 921 | /* Empty Rx FIFO */ |
| 941 | 922 | srb_packet_count = |
| 942 | 923 | FIELD_GET(KVASER_PCIEFD_SRB_RX_NR_PACKETS_MASK, |
| @@ -976,8 +957,7 @@ static int kvaser_pciefd_setup_board(struct kvaser_pciefd *pcie) · 33 unmodified lines | ||
| 976 | 957 | |
| 977 | 958 | srb_status = ioread32(pcie->reg_base + KVASER_PCIEFD_SRB_STAT_REG); |
| 978 | 959 | if (!(srb_status & KVASER_PCIEFD_SRB_STAT_DMA)) { |
| 979 | − dev_err(&pcie->pci->dev, | |
| 980 | − "Hardware without DMA is not supported\n"); | |
| 960 | + dev_err(&pcie->pci->dev, "Hardware without DMA is not supported\n"); | |
| 981 | 961 | return -ENODEV; |
| 982 | 962 | } |
| 983 | 963 | |
| @@ -987,9 +967,9 @@ static int kvaser_pciefd_setup_board(struct kvaser_pciefd *pcie) · 3 unmodified lines | ||
| 987 | 967 | pcie->freq_to_ticks_div = pcie->freq / 1000000; |
| 988 | 968 | if (pcie->freq_to_ticks_div == 0) |
| 989 | 969 | pcie->freq_to_ticks_div = 1; |
| 990 | − | |
| 991 | 970 | /* Turn off all loopback functionality */ |
| 992 | 971 | iowrite32(0, pcie->reg_base + KVASER_PCIEFD_LOOP_REG); |
| 972 | + | |
| 993 | 973 | return 0; |
| 994 | 974 | } |
| 995 | 975 | |
| @@ -1000,7 +980,6 @@ static int kvaser_pciefd_handle_data_packet(struct kvaser_pciefd *pcie, · 4 unmodified lines | ||
| 1000 | 980 | struct sk_buff *skb; |
| 1001 | 981 | struct canfd_frame *cf; |
| 1002 | 982 | struct can_priv *priv; |
| 1003 | − struct net_device_stats *stats; | |
| 1004 | 983 | u8 ch_id = FIELD_GET(KVASER_PCIEFD_PACKET_CHID_MASK, p->header[1]); |
| 1005 | 984 | u8 dlc; |
| 1006 | 985 | |
| @@ -1008,26 +987,24 @@ static int kvaser_pciefd_handle_data_packet(struct kvaser_pciefd *pcie, · 1 unmodified line | ||
| 1008 | 987 | return -EIO; |
| 1009 | 988 | |
| 1010 | 989 | priv = &pcie->can[ch_id]->can; |
| 1011 | − stats = &priv->dev->stats; | |
| 1012 | 990 | dlc = FIELD_GET(KVASER_PCIEFD_RPACKET_DLC_MASK, p->header[1]); |
| 1013 | 991 | |
| 1014 | 992 | if (p->header[1] & KVASER_PCIEFD_RPACKET_FDF) { |
| 1015 | 993 | skb = alloc_canfd_skb(priv->dev, &cf); |
| 1016 | 994 | if (!skb) { |
| 1017 | − stats->rx_dropped++; | |
| 995 | + priv->dev->stats.rx_dropped++; | |
| 1018 | 996 | return -ENOMEM; |
| 1019 | 997 | } |
| 1020 | 998 | |
| 1021 | 999 | cf->len = can_fd_dlc2len(dlc); |
| 1022 | 1000 | if (p->header[1] & KVASER_PCIEFD_RPACKET_BRS) |
| 1023 | 1001 | cf->flags |= CANFD_BRS; |
| 1024 | − | |
| 1025 | 1002 | if (p->header[1] & KVASER_PCIEFD_RPACKET_ESI) |
| 1026 | 1003 | cf->flags |= CANFD_ESI; |
| 1027 | 1004 | } else { |
| 1028 | 1005 | skb = alloc_can_skb(priv->dev, (struct can_frame **)&cf); |
| 1029 | 1006 | if (!skb) { |
| 1030 | − stats->rx_dropped++; | |
| 1007 | + priv->dev->stats.rx_dropped++; | |
| 1031 | 1008 | return -ENOMEM; |
| 1032 | 1009 | } |
| 1033 | 1010 | can_frame_set_cc_len((struct can_frame *)cf, dlc, priv->ctrlmode); |
| @@ -1041,10 +1018,9 @@ static int kvaser_pciefd_handle_data_packet(struct kvaser_pciefd *pcie, · 7 unmodified lines | ||
| 1041 | 1018 | cf->can_id |= CAN_RTR_FLAG; |
| 1042 | 1019 | } else { |
| 1043 | 1020 | memcpy(cf->data, data, cf->len); |
| 1044 | − | |
| 1045 | − stats->rx_bytes += cf->len; | |
| 1021 | + priv->dev->stats.rx_bytes += cf->len; | |
| 1046 | 1022 | } |
| 1047 | − stats->rx_packets++; | |
| 1023 | + priv->dev->stats.rx_packets++; | |
| 1048 | 1024 | kvaser_pciefd_set_skb_timestamp(pcie, skb, p->timestamp); |
| 1049 | 1025 | |
| 1050 | 1026 | return netif_rx(skb); |
| @@ -1065,7 +1041,6 @@ static void kvaser_pciefd_change_state(struct kvaser_pciefd_can *can, · 14 unmodified lines | ||
| 1065 | 1041 | spin_lock_irqsave(&can->lock, irq_flags); |
| 1066 | 1042 | netif_stop_queue(can->can.dev); |
| 1067 | 1043 | spin_unlock_irqrestore(&can->lock, irq_flags); |
| 1068 | − | |
| 1069 | 1044 | /* Prevent CAN controller from auto recover from bus off */ |
| 1070 | 1045 | if (!can->can.restart_ms) { |
| 1071 | 1046 | kvaser_pciefd_start_controller_flush(can); |
| @@ -1083,7 +1058,7 @@ static void kvaser_pciefd_packet_to_state(struct kvaser_pciefd_rx_packet *p, · 11 unmodified lines | ||
| 1083 | 1058 | if (p->header[0] & KVASER_PCIEFD_SPACK_BOFF || |
| 1084 | 1059 | p->header[0] & KVASER_PCIEFD_SPACK_IRM) |
| 1085 | 1060 | *new_state = CAN_STATE_BUS_OFF; |
| 1086 | − else if (bec->txerr >= 255 || bec->rxerr >= 255) | |
| 1061 | + else if (bec->txerr >= 255 || bec->rxerr >= 255) | |
| 1087 | 1062 | *new_state = CAN_STATE_BUS_OFF; |
| 1088 | 1063 | else if (p->header[1] & KVASER_PCIEFD_SPACK_EPLR) |
| 1089 | 1064 | *new_state = CAN_STATE_ERROR_PASSIVE; |
| @@ -1108,22 +1083,16 @@ static int kvaser_pciefd_rx_error_frame(struct kvaser_pciefd_can *can, · 18 unmodified lines | ||
| 1108 | 1083 | struct net_device *ndev = can->can.dev; |
| 1109 | 1084 | struct sk_buff *skb; |
| 1110 | 1085 | struct can_frame *cf = NULL; |
| 1111 | − struct net_device_stats *stats = &ndev->stats; | |
| 1112 | 1086 | |
| 1113 | 1087 | old_state = can->can.state; |
| 1114 | 1088 | |
| 1115 | 1089 | bec.txerr = FIELD_GET(KVASER_PCIEFD_SPACK_TXERR_MASK, p->header[0]); |
| 1116 | 1090 | bec.rxerr = FIELD_GET(KVASER_PCIEFD_SPACK_RXERR_MASK, p->header[0]); |
| 1117 | 1091 | |
| 1118 | − kvaser_pciefd_packet_to_state(p, &bec, &new_state, &tx_state, | |
| 1119 | − &rx_state); | |
| 1120 | − | |
| 1092 | + kvaser_pciefd_packet_to_state(p, &bec, &new_state, &tx_state, &rx_state); | |
| 1121 | 1093 | skb = alloc_can_err_skb(ndev, &cf); |
| 1122 | − | |
| 1123 | 1094 | if (new_state != old_state) { |
| 1124 | − kvaser_pciefd_change_state(can, cf, new_state, tx_state, | |
| 1125 | − rx_state); | |
| 1126 | − | |
| 1095 | + kvaser_pciefd_change_state(can, cf, new_state, tx_state, rx_state); | |
| 1127 | 1096 | if (old_state == CAN_STATE_BUS_OFF && |
| 1128 | 1097 | new_state == CAN_STATE_ERROR_ACTIVE && |
| 1129 | 1098 | can->can.restart_ms) { |
| @@ -1136,25 +1105,25 @@ static int kvaser_pciefd_rx_error_frame(struct kvaser_pciefd_can *can, · 6 unmodified lines | ||
| 1136 | 1105 | can->err_rep_cnt++; |
| 1137 | 1106 | can->can.can_stats.bus_error++; |
| 1138 | 1107 | if (p->header[1] & KVASER_PCIEFD_EPACK_DIR_TX) |
| 1139 | − stats->tx_errors++; | |
| 1108 | + ndev->stats.tx_errors++; | |
| 1140 | 1109 | else |
| 1141 | − stats->rx_errors++; | |
| 1110 | + ndev->stats.rx_errors++; | |
| 1142 | 1111 | |
| 1143 | 1112 | can->bec.txerr = bec.txerr; |
| 1144 | 1113 | can->bec.rxerr = bec.rxerr; |
| 1145 | 1114 | |
| 1146 | 1115 | if (!skb) { |
| 1147 | − stats->rx_dropped++; | |
| 1116 | + ndev->stats.rx_dropped++; | |
| 1148 | 1117 | return -ENOMEM; |
| 1149 | 1118 | } |
| 1150 | 1119 | |
| 1151 | 1120 | kvaser_pciefd_set_skb_timestamp(can->kv_pcie, skb, p->timestamp); |
| 1152 | 1121 | cf->can_id |= CAN_ERR_BUSERROR | CAN_ERR_CNT; |
| 1153 | − | |
| 1154 | 1122 | cf->data[6] = bec.txerr; |
| 1155 | 1123 | cf->data[7] = bec.rxerr; |
| 1156 | 1124 | |
| 1157 | 1125 | netif_rx(skb); |
| 1126 | + | |
| 1158 | 1127 | return 0; |
| 1159 | 1128 | } |
| 1160 | 1129 | |
| @@ -1168,13 +1137,13 @@ static int kvaser_pciefd_handle_error_packet(struct kvaser_pciefd *pcie, · 7 unmodified lines | ||
| 1168 | 1137 | return -EIO; |
| 1169 | 1138 | |
| 1170 | 1139 | can = pcie->can[ch_id]; |
| 1171 | − | |
| 1172 | 1140 | kvaser_pciefd_rx_error_frame(can, p); |
| 1173 | 1141 | if (can->err_rep_cnt >= KVASER_PCIEFD_MAX_ERR_REP) |
| 1174 | 1142 | /* Do not report more errors, until bec_poll_timer expires */ |
| 1175 | 1143 | kvaser_pciefd_disable_err_gen(can); |
| 1176 | 1144 | /* Start polling the error counters */ |
| 1177 | 1145 | mod_timer(&can->bec_poll_timer, KVASER_PCIEFD_BEC_POLL_FREQ); |
| 1146 | + | |
| 1178 | 1147 | return 0; |
| 1179 | 1148 | } |
| 1180 | 1149 | |
| @@ -1189,9 +1158,7 @@ static int kvaser_pciefd_handle_status_resp(struct kvaser_pciefd_can *can, · 8 unmodified lines | ||
| 1189 | 1158 | bec.txerr = FIELD_GET(KVASER_PCIEFD_SPACK_TXERR_MASK, p->header[0]); |
| 1190 | 1159 | bec.rxerr = FIELD_GET(KVASER_PCIEFD_SPACK_RXERR_MASK, p->header[0]); |
| 1191 | 1160 | |
| 1192 | − kvaser_pciefd_packet_to_state(p, &bec, &new_state, &tx_state, | |
| 1193 | − &rx_state); | |
| 1194 | − | |
| 1161 | + kvaser_pciefd_packet_to_state(p, &bec, &new_state, &tx_state, &rx_state); | |
| 1195 | 1162 | if (new_state != old_state) { |
| 1196 | 1163 | struct net_device *ndev = can->can.dev; |
| 1197 | 1164 | struct sk_buff *skb; |
| @@ -1199,15 +1166,11 @@ static int kvaser_pciefd_handle_status_resp(struct kvaser_pciefd_can *can, · 1 unmodified line | ||
| 1199 | 1166 | |
| 1200 | 1167 | skb = alloc_can_err_skb(ndev, &cf); |
| 1201 | 1168 | if (!skb) { |
| 1202 | − struct net_device_stats *stats = &ndev->stats; | |
| 1203 | − | |
| 1204 | − stats->rx_dropped++; | |
| 1169 | + ndev->stats.rx_dropped++; | |
| 1205 | 1170 | return -ENOMEM; |
| 1206 | 1171 | } |
| 1207 | 1172 | |
| 1208 | − kvaser_pciefd_change_state(can, cf, new_state, tx_state, | |
| 1209 | − rx_state); | |
| 1210 | − | |
| 1173 | + kvaser_pciefd_change_state(can, cf, new_state, tx_state, rx_state); | |
| 1211 | 1174 | if (old_state == CAN_STATE_BUS_OFF && |
| 1212 | 1175 | new_state == CAN_STATE_ERROR_ACTIVE && |
| 1213 | 1176 | can->can.restart_ms) { |
| @@ -1253,21 +1216,18 @@ static int kvaser_pciefd_handle_status_packet(struct kvaser_pciefd *pcie, · 39 unmodified lines | ||
| 1253 | 1216 | p->header[1] & KVASER_PCIEFD_SPACK_AUTO && |
| 1254 | 1217 | cmdseq == FIELD_GET(KVASER_PCIEFD_PACKET_SEQ_MASK, p->header[1]) && |
| 1255 | 1218 | status & KVASER_PCIEFD_KCAN_STAT_IDLE) { |
| 1256 | − u32 cmd; | |
| 1257 | − | |
| 1258 | 1219 | iowrite32(KVASER_PCIEFD_KCAN_IRQ_ABD, |
| 1259 | 1220 | can->reg_base + KVASER_PCIEFD_KCAN_IRQ_REG); |
| 1260 | − cmd = KVASER_PCIEFD_KCAN_CMD_AT; | |
| 1261 | − cmd |= FIELD_PREP(KVASER_PCIEFD_KCAN_CMD_SEQ_MASK, ++can->cmd_seq); | |
| 1262 | − iowrite32(cmd, can->reg_base + KVASER_PCIEFD_KCAN_CMD_REG); | |
| 1221 | + kvaser_pciefd_abort_flush_reset(can); | |
| 1263 | 1222 | } else if (p->header[0] & KVASER_PCIEFD_SPACK_IDET && |
| 1264 | 1223 | p->header[0] & KVASER_PCIEFD_SPACK_IRM && |
| 1265 | 1224 | cmdseq == FIELD_GET(KVASER_PCIEFD_PACKET_SEQ_MASK, p->header[1]) && |
| 1266 | 1225 | status & KVASER_PCIEFD_KCAN_STAT_IDLE) { |
| 1267 | 1226 | /* Reset detected, send end of flush if no packet are in FIFO */ |
| 1268 | − u8 count = FIELD_GET(KVASER_PCIEFD_KCAN_TX_NR_PACKETS_CURRENT_MASK, | |
| 1269 | − ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NPACKETS_REG)); | |
| 1227 | + u8 count; | |
| 1270 | 1228 | |
| 1229 | + count = FIELD_GET(KVASER_PCIEFD_KCAN_TX_NR_PACKETS_CURRENT_MASK, | |
| 1230 | + ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NR_PACKETS_REG)); | |
| 1271 | 1231 | if (!count) |
| 1272 | 1232 | iowrite32(FIELD_PREP(KVASER_PCIEFD_KCAN_CTRL_TYPE_MASK, |
| 1273 | 1233 | KVASER_PCIEFD_KCAN_CTRL_TYPE_EFLUSH), |
| @@ -1278,11 +1238,10 @@ static int kvaser_pciefd_handle_status_packet(struct kvaser_pciefd *pcie, · 4 unmodified lines | ||
| 1278 | 1238 | kvaser_pciefd_handle_status_resp(can, p); |
| 1279 | 1239 | if (can->can.state != CAN_STATE_BUS_OFF && |
| 1280 | 1240 | can->can.state != CAN_STATE_ERROR_ACTIVE) { |
| 1281 | − mod_timer(&can->bec_poll_timer, | |
| 1282 | − KVASER_PCIEFD_BEC_POLL_FREQ); | |
| 1241 | + mod_timer(&can->bec_poll_timer, KVASER_PCIEFD_BEC_POLL_FREQ); | |
| 1283 | 1242 | } |
| 1284 | 1243 | } else if (p->header[0] & KVASER_PCIEFD_SPACK_RMCD && |
| 1285 | − !(status & KVASER_PCIEFD_KCAN_STAT_BUS_OFF_MSK)) { | |
| 1244 | + !(status & KVASER_PCIEFD_KCAN_STAT_BUS_OFF_MASK)) { | |
| 1286 | 1245 | /* Reset to bus on detected */ |
| 1287 | 1246 | if (!completion_done(&can->start_comp)) |
| 1288 | 1247 | complete(&can->start_comp); |
| @@ -1295,12 +1254,10 @@ static void kvaser_pciefd_handle_nack_packet(struct kvaser_pciefd_can *can, · 6 unmodified lines | ||
| 1295 | 1254 | struct kvaser_pciefd_rx_packet *p) |
| 1296 | 1255 | { |
| 1297 | 1256 | struct sk_buff *skb; |
| 1298 | − struct net_device_stats *stats = &can->can.dev->stats; | |
| 1299 | 1257 | struct can_frame *cf; |
| 1300 | 1258 | |
| 1301 | 1259 | skb = alloc_can_err_skb(can->can.dev, &cf); |
| 1302 | − | |
| 1303 | − stats->tx_errors++; | |
| 1260 | + can->can.dev->stats.tx_errors++; | |
| 1304 | 1261 | if (p->header[0] & KVASER_PCIEFD_APACKET_ABL) { |
| 1305 | 1262 | if (skb) |
| 1306 | 1263 | cf->can_id |= CAN_ERR_LOSTARB; |
| @@ -1314,7 +1271,7 @@ static void kvaser_pciefd_handle_nack_packet(struct kvaser_pciefd_can *can, · 7 unmodified lines | ||
| 1314 | 1271 | kvaser_pciefd_set_skb_timestamp(can->kv_pcie, skb, p->timestamp); |
| 1315 | 1272 | netif_rx(skb); |
| 1316 | 1273 | } else { |
| 1317 | − stats->rx_dropped++; | |
| 1274 | + can->can.dev->stats.rx_dropped++; | |
| 1318 | 1275 | netdev_warn(can->can.dev, "No memory left for err_skb\n"); |
| 1319 | 1276 | } |
| 1320 | 1277 | } |
| @@ -1343,26 +1300,24 @@ static int kvaser_pciefd_handle_ack_packet(struct kvaser_pciefd *pcie, · 22 unmodified lines | ||
| 1343 | 1300 | netdev_dbg(can->can.dev, "Packet was flushed\n"); |
| 1344 | 1301 | } else { |
| 1345 | 1302 | int echo_idx = FIELD_GET(KVASER_PCIEFD_PACKET_SEQ_MASK, p->header[0]); |
| 1346 | − int dlc; | |
| 1303 | + int len; | |
| 1347 | 1304 | u8 count; |
| 1348 | 1305 | struct sk_buff *skb; |
| 1349 | 1306 | |
| 1350 | 1307 | skb = can->can.echo_skb[echo_idx]; |
| 1351 | 1308 | if (skb) |
| 1352 | 1309 | kvaser_pciefd_set_skb_timestamp(pcie, skb, p->timestamp); |
| 1353 | − dlc = can_get_echo_skb(can->can.dev, echo_idx, NULL); | |
| 1310 | + len = can_get_echo_skb(can->can.dev, echo_idx, NULL); | |
| 1354 | 1311 | count = FIELD_GET(KVASER_PCIEFD_KCAN_TX_NR_PACKETS_CURRENT_MASK, |
| 1355 | − ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NPACKETS_REG)); | |
| 1312 | + ioread32(can->reg_base + KVASER_PCIEFD_KCAN_TX_NR_PACKETS_REG)); | |
| 1356 | 1313 | |
| 1357 | 1314 | if (count < KVASER_PCIEFD_CAN_TX_MAX_COUNT && |
| 1358 | 1315 | netif_queue_stopped(can->can.dev)) |
| 1359 | 1316 | netif_wake_queue(can->can.dev); |
| 1360 | 1317 | |
| 1361 | 1318 | if (!one_shot_fail) { |
| 1362 | − struct net_device_stats *stats = &can->can.dev->stats; | |
| 1363 | − | |
| 1364 | − stats->tx_bytes += dlc; | |
| 1365 | − stats->tx_packets++; | |
| 1319 | + can->can.dev->stats.tx_bytes += len; | |
| 1320 | + can->can.dev->stats.tx_packets++; | |
| 1366 | 1321 | } |
| 1367 | 1322 | } |
| 1368 | 1323 | |
| @@ -1562,13 +1517,12 @@ static irqreturn_t kvaser_pciefd_irq_handler(int irq, void *dev) · 193 unmodified lines | ||
| 1562 | 1517 | static void kvaser_pciefd_teardown_can_ctrls(struct kvaser_pciefd *pcie) |
| 1563 | 1518 | { |
| 1564 | 1519 | int i; |
| 1565 | − struct kvaser_pciefd_can *can; | |
| 1566 | 1520 | |
| 1567 | 1521 | for (i = 0; i < pcie->nr_channels; i++) { |
| 1568 | − can = pcie->can[i]; | |
| 1522 | + struct kvaser_pciefd_can *can = pcie->can[i]; | |
| 1523 | + | |
| 1569 | 1524 | if (can) { |
| 1570 | − iowrite32(0, | |
| 1571 | − can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); | |
| 1525 | + iowrite32(0, can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); | |
| 1572 | 1526 | kvaser_pciefd_pwm_stop(can); |
| 1573 | 1527 | free_candev(can->can.dev); |
| 1574 | 1528 | } |
| @@ -1669,14 +1623,13 @@ err_disable_pci: · 94 unmodified lines | ||
| 1669 | 1623 | |
| 1670 | 1624 | static void kvaser_pciefd_remove_all_ctrls(struct kvaser_pciefd *pcie) |
| 1671 | 1625 | { |
| 1672 | − struct kvaser_pciefd_can *can; | |
| 1673 | 1626 | int i; |
| 1674 | 1627 | |
| 1675 | 1628 | for (i = 0; i < pcie->nr_channels; i++) { |
| 1676 | − can = pcie->can[i]; | |
| 1629 | + struct kvaser_pciefd_can *can = pcie->can[i]; | |
| 1630 | + | |
| 1677 | 1631 | if (can) { |
| 1678 | − iowrite32(0, | |
| 1679 | − can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); | |
| 1632 | + iowrite32(0, can->reg_base + KVASER_PCIEFD_KCAN_IEN_REG); | |
| 1680 | 1633 | unregister_candev(can->can.dev); |
| 1681 | 1634 | del_timer(&can->bec_poll_timer); |
| 1682 | 1635 | kvaser_pciefd_pwm_stop(can); |