Lines Matching +full:- +full:spi
1 // SPDX-License-Identifier: GPL-2.0-only
2 /* CAN bus driver for Microchip 251x/25625 CAN Controller with SPI Interface
17 * - Sascha Hauer, Marc Kleine-Budde, Pengutronix
18 * - Simon Kallweit, intefo AG
43 #include <linux/spi/spi.h>
46 /* SPI interface instruction set */
197 /* Buffer size required for the largest SPI transfer (i.e., reading a
231 struct spi_device *spi; member
234 struct mutex mcp_lock; /* SPI device lock */
263 static inline int mcp251x_is_##_model(struct spi_device *spi) \
265 struct mcp251x_priv *priv = spi_get_drvdata(spi); \
266 return priv->model == CAN_MCP251X_MCP##_model; \
275 if (priv->tx_skb || priv->tx_len) in mcp251x_clean()
276 net->stats.tx_errors++; in mcp251x_clean()
277 dev_kfree_skb(priv->tx_skb); in mcp251x_clean()
278 if (priv->tx_len) in mcp251x_clean()
279 can_free_echo_skb(priv->net, 0, NULL); in mcp251x_clean()
280 priv->tx_skb = NULL; in mcp251x_clean()
281 priv->tx_len = 0; in mcp251x_clean()
285 * registers via SPI is not really different conceptually than using
296 static int mcp251x_spi_trans(struct spi_device *spi, int len) in mcp251x_spi_trans() argument
298 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_spi_trans()
300 .tx_buf = priv->spi_tx_buf, in mcp251x_spi_trans()
301 .rx_buf = priv->spi_rx_buf, in mcp251x_spi_trans()
311 ret = spi_sync(spi, &m); in mcp251x_spi_trans()
313 dev_err(&spi->dev, "spi transfer failed: ret = %d\n", ret); in mcp251x_spi_trans()
317 static int mcp251x_spi_write(struct spi_device *spi, int len) in mcp251x_spi_write() argument
319 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_spi_write()
322 ret = spi_write(spi, priv->spi_tx_buf, len); in mcp251x_spi_write()
324 dev_err(&spi->dev, "spi write failed: ret = %d\n", ret); in mcp251x_spi_write()
329 static u8 mcp251x_read_reg(struct spi_device *spi, u8 reg) in mcp251x_read_reg() argument
331 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_read_reg()
334 priv->spi_tx_buf[0] = INSTRUCTION_READ; in mcp251x_read_reg()
335 priv->spi_tx_buf[1] = reg; in mcp251x_read_reg()
337 if (spi->controller->flags & SPI_CONTROLLER_HALF_DUPLEX) { in mcp251x_read_reg()
338 spi_write_then_read(spi, priv->spi_tx_buf, 2, &val, 1); in mcp251x_read_reg()
340 mcp251x_spi_trans(spi, 3); in mcp251x_read_reg()
341 val = priv->spi_rx_buf[2]; in mcp251x_read_reg()
347 static void mcp251x_read_2regs(struct spi_device *spi, u8 reg, u8 *v1, u8 *v2) in mcp251x_read_2regs() argument
349 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_read_2regs()
351 priv->spi_tx_buf[0] = INSTRUCTION_READ; in mcp251x_read_2regs()
352 priv->spi_tx_buf[1] = reg; in mcp251x_read_2regs()
354 if (spi->controller->flags & SPI_CONTROLLER_HALF_DUPLEX) { in mcp251x_read_2regs()
357 spi_write_then_read(spi, priv->spi_tx_buf, 2, val, 2); in mcp251x_read_2regs()
361 mcp251x_spi_trans(spi, 4); in mcp251x_read_2regs()
363 *v1 = priv->spi_rx_buf[2]; in mcp251x_read_2regs()
364 *v2 = priv->spi_rx_buf[3]; in mcp251x_read_2regs()
368 static void mcp251x_write_reg(struct spi_device *spi, u8 reg, u8 val) in mcp251x_write_reg() argument
370 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_write_reg()
372 priv->spi_tx_buf[0] = INSTRUCTION_WRITE; in mcp251x_write_reg()
373 priv->spi_tx_buf[1] = reg; in mcp251x_write_reg()
374 priv->spi_tx_buf[2] = val; in mcp251x_write_reg()
376 mcp251x_spi_write(spi, 3); in mcp251x_write_reg()
379 static void mcp251x_write_2regs(struct spi_device *spi, u8 reg, u8 v1, u8 v2) in mcp251x_write_2regs() argument
381 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_write_2regs()
383 priv->spi_tx_buf[0] = INSTRUCTION_WRITE; in mcp251x_write_2regs()
384 priv->spi_tx_buf[1] = reg; in mcp251x_write_2regs()
385 priv->spi_tx_buf[2] = v1; in mcp251x_write_2regs()
386 priv->spi_tx_buf[3] = v2; in mcp251x_write_2regs()
388 mcp251x_spi_write(spi, 4); in mcp251x_write_2regs()
391 static void mcp251x_write_bits(struct spi_device *spi, u8 reg, in mcp251x_write_bits() argument
394 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_write_bits()
396 priv->spi_tx_buf[0] = INSTRUCTION_BIT_MODIFY; in mcp251x_write_bits()
397 priv->spi_tx_buf[1] = reg; in mcp251x_write_bits()
398 priv->spi_tx_buf[2] = mask; in mcp251x_write_bits()
399 priv->spi_tx_buf[3] = val; in mcp251x_write_bits()
401 mcp251x_spi_write(spi, 4); in mcp251x_write_bits()
404 static u8 mcp251x_read_stat(struct spi_device *spi) in mcp251x_read_stat() argument
406 return mcp251x_read_reg(spi, CANSTAT) & CANCTRL_REQOP_MASK; in mcp251x_read_stat()
450 val = BFPCTRL_BFE(offset - MCP251X_GPIO_RX0BF); in mcp251x_gpio_request()
452 mutex_lock(&priv->mcp_lock); in mcp251x_gpio_request()
453 mcp251x_write_bits(priv->spi, BFPCTRL, val, val); in mcp251x_gpio_request()
454 mutex_unlock(&priv->mcp_lock); in mcp251x_gpio_request()
456 priv->reg_bfpctrl |= val; in mcp251x_gpio_request()
471 val = BFPCTRL_BFE(offset - MCP251X_GPIO_RX0BF); in mcp251x_gpio_free()
473 mutex_lock(&priv->mcp_lock); in mcp251x_gpio_free()
474 mcp251x_write_bits(priv->spi, BFPCTRL, val, 0); in mcp251x_gpio_free()
475 mutex_unlock(&priv->mcp_lock); in mcp251x_gpio_free()
477 priv->reg_bfpctrl &= ~val; in mcp251x_gpio_free()
499 mask = BFPCTRL_BFS(offset - MCP251X_GPIO_RX0BF); in mcp251x_gpio_get()
502 mutex_lock(&priv->mcp_lock); in mcp251x_gpio_get()
503 val = mcp251x_read_reg(priv->spi, reg); in mcp251x_gpio_get()
504 mutex_unlock(&priv->mcp_lock); in mcp251x_gpio_get()
516 mutex_lock(&priv->mcp_lock); in mcp251x_gpio_get_multiple()
518 val = mcp251x_read_reg(priv->spi, TXRTSCTRL); in mcp251x_gpio_get_multiple()
523 val = mcp251x_read_reg(priv->spi, BFPCTRL); in mcp251x_gpio_get_multiple()
527 mutex_unlock(&priv->mcp_lock); in mcp251x_gpio_get_multiple()
539 mask = BFPCTRL_BFS(offset - MCP251X_GPIO_RX0BF); in mcp251x_gpio_set()
542 mutex_lock(&priv->mcp_lock); in mcp251x_gpio_set()
543 mcp251x_write_bits(priv->spi, BFPCTRL, mask, val); in mcp251x_gpio_set()
544 mutex_unlock(&priv->mcp_lock); in mcp251x_gpio_set()
546 priv->reg_bfpctrl &= ~mask; in mcp251x_gpio_set()
547 priv->reg_bfpctrl |= val; in mcp251x_gpio_set()
566 mutex_lock(&priv->mcp_lock); in mcp251x_gpio_set_multiple()
567 mcp251x_write_bits(priv->spi, BFPCTRL, mask, val); in mcp251x_gpio_set_multiple()
568 mutex_unlock(&priv->mcp_lock); in mcp251x_gpio_set_multiple()
570 priv->reg_bfpctrl &= ~mask; in mcp251x_gpio_set_multiple()
571 priv->reg_bfpctrl |= val; in mcp251x_gpio_set_multiple()
574 static void mcp251x_gpio_restore(struct spi_device *spi) in mcp251x_gpio_restore() argument
576 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_gpio_restore()
578 mcp251x_write_reg(spi, BFPCTRL, priv->reg_bfpctrl); in mcp251x_gpio_restore()
583 struct gpio_chip *gpio = &priv->gpio; in mcp251x_gpio_setup()
585 if (!device_property_present(&priv->spi->dev, "gpio-controller")) in mcp251x_gpio_setup()
589 gpio->label = priv->spi->modalias; in mcp251x_gpio_setup()
590 gpio->parent = &priv->spi->dev; in mcp251x_gpio_setup()
591 gpio->owner = THIS_MODULE; in mcp251x_gpio_setup()
592 gpio->request = mcp251x_gpio_request; in mcp251x_gpio_setup()
593 gpio->free = mcp251x_gpio_free; in mcp251x_gpio_setup()
594 gpio->get_direction = mcp251x_gpio_get_direction; in mcp251x_gpio_setup()
595 gpio->get = mcp251x_gpio_get; in mcp251x_gpio_setup()
596 gpio->get_multiple = mcp251x_gpio_get_multiple; in mcp251x_gpio_setup()
597 gpio->set = mcp251x_gpio_set; in mcp251x_gpio_setup()
598 gpio->set_multiple = mcp251x_gpio_set_multiple; in mcp251x_gpio_setup()
599 gpio->base = -1; in mcp251x_gpio_setup()
600 gpio->ngpio = ARRAY_SIZE(mcp251x_gpio_names); in mcp251x_gpio_setup()
601 gpio->names = mcp251x_gpio_names; in mcp251x_gpio_setup()
602 gpio->can_sleep = true; in mcp251x_gpio_setup()
604 gpio->of_node = priv->spi->dev.of_node; in mcp251x_gpio_setup()
607 return devm_gpiochip_add_data(&priv->spi->dev, gpio, priv); in mcp251x_gpio_setup()
610 static inline void mcp251x_gpio_restore(struct spi_device *spi) in mcp251x_gpio_restore() argument
620 static void mcp251x_hw_tx_frame(struct spi_device *spi, u8 *buf, in mcp251x_hw_tx_frame() argument
623 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_hw_tx_frame()
625 if (mcp251x_is_2510(spi)) { in mcp251x_hw_tx_frame()
629 mcp251x_write_reg(spi, TXBCTRL(tx_buf_idx) + i, in mcp251x_hw_tx_frame()
632 memcpy(priv->spi_tx_buf, buf, TXBDAT_OFF + len); in mcp251x_hw_tx_frame()
633 mcp251x_spi_write(spi, TXBDAT_OFF + len); in mcp251x_hw_tx_frame()
637 static void mcp251x_hw_tx(struct spi_device *spi, struct can_frame *frame, in mcp251x_hw_tx() argument
640 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_hw_tx()
644 exide = (frame->can_id & CAN_EFF_FLAG) ? 1 : 0; /* Extended ID Enable */ in mcp251x_hw_tx()
646 sid = (frame->can_id & CAN_EFF_MASK) >> 18; in mcp251x_hw_tx()
648 sid = frame->can_id & CAN_SFF_MASK; /* Standard ID */ in mcp251x_hw_tx()
649 eid = frame->can_id & CAN_EFF_MASK; /* Extended ID */ in mcp251x_hw_tx()
650 rtr = (frame->can_id & CAN_RTR_FLAG) ? 1 : 0; /* Remote transmission */ in mcp251x_hw_tx()
659 buf[TXBDLC_OFF] = (rtr << DLC_RTR_SHIFT) | frame->len; in mcp251x_hw_tx()
660 memcpy(buf + TXBDAT_OFF, frame->data, frame->len); in mcp251x_hw_tx()
661 mcp251x_hw_tx_frame(spi, buf, frame->len, tx_buf_idx); in mcp251x_hw_tx()
664 priv->spi_tx_buf[0] = INSTRUCTION_RTS(1 << tx_buf_idx); in mcp251x_hw_tx()
665 mcp251x_spi_write(priv->spi, 1); in mcp251x_hw_tx()
668 static void mcp251x_hw_rx_frame(struct spi_device *spi, u8 *buf, in mcp251x_hw_rx_frame() argument
671 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_hw_rx_frame()
673 if (mcp251x_is_2510(spi)) { in mcp251x_hw_rx_frame()
677 buf[i] = mcp251x_read_reg(spi, RXBCTRL(buf_idx) + i); in mcp251x_hw_rx_frame()
681 buf[i] = mcp251x_read_reg(spi, RXBCTRL(buf_idx) + i); in mcp251x_hw_rx_frame()
683 priv->spi_tx_buf[RXBCTRL_OFF] = INSTRUCTION_READ_RXB(buf_idx); in mcp251x_hw_rx_frame()
684 if (spi->controller->flags & SPI_CONTROLLER_HALF_DUPLEX) { in mcp251x_hw_rx_frame()
685 spi_write_then_read(spi, priv->spi_tx_buf, 1, in mcp251x_hw_rx_frame()
686 priv->spi_rx_buf, in mcp251x_hw_rx_frame()
688 memcpy(buf + 1, priv->spi_rx_buf, in mcp251x_hw_rx_frame()
689 SPI_TRANSFER_BUF_LEN - 1); in mcp251x_hw_rx_frame()
691 mcp251x_spi_trans(spi, SPI_TRANSFER_BUF_LEN); in mcp251x_hw_rx_frame()
692 memcpy(buf, priv->spi_rx_buf, SPI_TRANSFER_BUF_LEN); in mcp251x_hw_rx_frame()
697 static void mcp251x_hw_rx(struct spi_device *spi, int buf_idx) in mcp251x_hw_rx() argument
699 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_hw_rx()
704 skb = alloc_can_skb(priv->net, &frame); in mcp251x_hw_rx()
706 dev_err(&spi->dev, "cannot allocate RX skb\n"); in mcp251x_hw_rx()
707 priv->net->stats.rx_dropped++; in mcp251x_hw_rx()
711 mcp251x_hw_rx_frame(spi, buf, buf_idx); in mcp251x_hw_rx()
714 frame->can_id = CAN_EFF_FLAG; in mcp251x_hw_rx()
715 frame->can_id |= in mcp251x_hw_rx()
725 frame->can_id |= CAN_RTR_FLAG; in mcp251x_hw_rx()
728 frame->can_id = in mcp251x_hw_rx()
732 frame->can_id |= CAN_RTR_FLAG; in mcp251x_hw_rx()
735 frame->len = can_cc_dlc2len(buf[RXBDLC_OFF] & RXBDLC_LEN_MASK); in mcp251x_hw_rx()
736 memcpy(frame->data, buf + RXBDAT_OFF, frame->len); in mcp251x_hw_rx()
738 priv->net->stats.rx_packets++; in mcp251x_hw_rx()
739 priv->net->stats.rx_bytes += frame->len; in mcp251x_hw_rx()
741 can_led_event(priv->net, CAN_LED_EVENT_RX); in mcp251x_hw_rx()
746 static void mcp251x_hw_sleep(struct spi_device *spi) in mcp251x_hw_sleep() argument
748 mcp251x_write_reg(spi, CANCTRL, CANCTRL_REQOP_SLEEP); in mcp251x_hw_sleep()
752 static int mcp251x_hw_wake(struct spi_device *spi) in mcp251x_hw_wake() argument
758 disable_irq(spi->irq); in mcp251x_hw_wake()
759 mcp251x_write_2regs(spi, CANINTE, CANINTE_WAKIE, CANINTF_WAKIF); in mcp251x_hw_wake()
765 mcp251x_write_reg(spi, CANCTRL, CANCTRL_REQOP_CONF); in mcp251x_hw_wake()
768 ret = mcp251x_read_stat_poll_timeout(spi, value, value == CANCTRL_REQOP_CONF, in mcp251x_hw_wake()
772 dev_err(&spi->dev, "MCP251x didn't enter in config mode\n"); in mcp251x_hw_wake()
777 mcp251x_write_2regs(spi, CANINTE, 0x00, 0x00); in mcp251x_hw_wake()
778 enable_irq(spi->irq); in mcp251x_hw_wake()
787 struct spi_device *spi = priv->spi; in mcp251x_hard_start_xmit() local
789 if (priv->tx_skb || priv->tx_len) { in mcp251x_hard_start_xmit()
790 dev_warn(&spi->dev, "hard_xmit called while tx busy\n"); in mcp251x_hard_start_xmit()
798 priv->tx_skb = skb; in mcp251x_hard_start_xmit()
799 queue_work(priv->wq, &priv->tx_work); in mcp251x_hard_start_xmit()
811 /* We have to delay work since SPI I/O may sleep */ in mcp251x_do_set_mode()
812 priv->can.state = CAN_STATE_ERROR_ACTIVE; in mcp251x_do_set_mode()
813 priv->restart_tx = 1; in mcp251x_do_set_mode()
814 if (priv->can.restart_ms == 0) in mcp251x_do_set_mode()
815 priv->after_suspend = AFTER_SUSPEND_RESTART; in mcp251x_do_set_mode()
816 queue_work(priv->wq, &priv->restart_work); in mcp251x_do_set_mode()
819 return -EOPNOTSUPP; in mcp251x_do_set_mode()
825 static int mcp251x_set_normal_mode(struct spi_device *spi) in mcp251x_set_normal_mode() argument
827 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_set_normal_mode()
832 mcp251x_write_reg(spi, CANINTE, in mcp251x_set_normal_mode()
836 if (priv->can.ctrlmode & CAN_CTRLMODE_LOOPBACK) { in mcp251x_set_normal_mode()
838 mcp251x_write_reg(spi, CANCTRL, CANCTRL_REQOP_LOOPBACK); in mcp251x_set_normal_mode()
839 } else if (priv->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) { in mcp251x_set_normal_mode()
840 /* Put device into listen-only mode */ in mcp251x_set_normal_mode()
841 mcp251x_write_reg(spi, CANCTRL, CANCTRL_REQOP_LISTEN_ONLY); in mcp251x_set_normal_mode()
844 mcp251x_write_reg(spi, CANCTRL, CANCTRL_REQOP_NORMAL); in mcp251x_set_normal_mode()
847 ret = mcp251x_read_stat_poll_timeout(spi, value, value == 0, in mcp251x_set_normal_mode()
851 dev_err(&spi->dev, "MCP251x didn't enter in normal mode\n"); in mcp251x_set_normal_mode()
855 priv->can.state = CAN_STATE_ERROR_ACTIVE; in mcp251x_set_normal_mode()
862 struct can_bittiming *bt = &priv->can.bittiming; in mcp251x_do_set_bittiming()
863 struct spi_device *spi = priv->spi; in mcp251x_do_set_bittiming() local
865 mcp251x_write_reg(spi, CNF1, ((bt->sjw - 1) << CNF1_SJW_SHIFT) | in mcp251x_do_set_bittiming()
866 (bt->brp - 1)); in mcp251x_do_set_bittiming()
867 mcp251x_write_reg(spi, CNF2, CNF2_BTLMODE | in mcp251x_do_set_bittiming()
868 (priv->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES ? in mcp251x_do_set_bittiming()
870 ((bt->phase_seg1 - 1) << CNF2_PS1_SHIFT) | in mcp251x_do_set_bittiming()
871 (bt->prop_seg - 1)); in mcp251x_do_set_bittiming()
872 mcp251x_write_bits(spi, CNF3, CNF3_PHSEG2_MASK, in mcp251x_do_set_bittiming()
873 (bt->phase_seg2 - 1)); in mcp251x_do_set_bittiming()
874 dev_dbg(&spi->dev, "CNF: 0x%02x 0x%02x 0x%02x\n", in mcp251x_do_set_bittiming()
875 mcp251x_read_reg(spi, CNF1), in mcp251x_do_set_bittiming()
876 mcp251x_read_reg(spi, CNF2), in mcp251x_do_set_bittiming()
877 mcp251x_read_reg(spi, CNF3)); in mcp251x_do_set_bittiming()
882 static int mcp251x_setup(struct net_device *net, struct spi_device *spi) in mcp251x_setup() argument
886 mcp251x_write_reg(spi, RXBCTRL(0), in mcp251x_setup()
888 mcp251x_write_reg(spi, RXBCTRL(1), in mcp251x_setup()
893 static int mcp251x_hw_reset(struct spi_device *spi) in mcp251x_hw_reset() argument
895 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_hw_reset()
902 priv->spi_tx_buf[0] = INSTRUCTION_RESET; in mcp251x_hw_reset()
903 ret = mcp251x_spi_write(spi, 1); in mcp251x_hw_reset()
911 ret = mcp251x_read_stat_poll_timeout(spi, value, value == CANCTRL_REQOP_CONF, in mcp251x_hw_reset()
915 dev_err(&spi->dev, "MCP251x didn't enter in conf mode after reset\n"); in mcp251x_hw_reset()
919 static int mcp251x_hw_probe(struct spi_device *spi) in mcp251x_hw_probe() argument
924 ret = mcp251x_hw_reset(spi); in mcp251x_hw_probe()
928 ctrl = mcp251x_read_reg(spi, CANCTRL); in mcp251x_hw_probe()
930 dev_dbg(&spi->dev, "CANCTRL 0x%02x\n", ctrl); in mcp251x_hw_probe()
934 return -ENODEV; in mcp251x_hw_probe()
953 struct spi_device *spi = priv->spi; in mcp251x_stop() local
957 priv->force_quit = 1; in mcp251x_stop()
958 free_irq(spi->irq, priv); in mcp251x_stop()
960 mutex_lock(&priv->mcp_lock); in mcp251x_stop()
963 mcp251x_write_2regs(spi, CANINTE, 0x00, 0x00); in mcp251x_stop()
965 mcp251x_write_reg(spi, TXBCTRL(0), 0); in mcp251x_stop()
968 mcp251x_hw_sleep(spi); in mcp251x_stop()
970 mcp251x_power_enable(priv->transceiver, 0); in mcp251x_stop()
972 priv->can.state = CAN_STATE_STOPPED; in mcp251x_stop()
974 mutex_unlock(&priv->mcp_lock); in mcp251x_stop()
988 frame->can_id |= can_id; in mcp251x_error_skb()
989 frame->data[1] = data1; in mcp251x_error_skb()
1000 struct spi_device *spi = priv->spi; in mcp251x_tx_work_handler() local
1001 struct net_device *net = priv->net; in mcp251x_tx_work_handler()
1004 mutex_lock(&priv->mcp_lock); in mcp251x_tx_work_handler()
1005 if (priv->tx_skb) { in mcp251x_tx_work_handler()
1006 if (priv->can.state == CAN_STATE_BUS_OFF) { in mcp251x_tx_work_handler()
1009 frame = (struct can_frame *)priv->tx_skb->data; in mcp251x_tx_work_handler()
1011 if (frame->len > CAN_FRAME_MAX_DATA_LEN) in mcp251x_tx_work_handler()
1012 frame->len = CAN_FRAME_MAX_DATA_LEN; in mcp251x_tx_work_handler()
1013 mcp251x_hw_tx(spi, frame, 0); in mcp251x_tx_work_handler()
1014 priv->tx_len = 1 + frame->len; in mcp251x_tx_work_handler()
1015 can_put_echo_skb(priv->tx_skb, net, 0, 0); in mcp251x_tx_work_handler()
1016 priv->tx_skb = NULL; in mcp251x_tx_work_handler()
1019 mutex_unlock(&priv->mcp_lock); in mcp251x_tx_work_handler()
1026 struct spi_device *spi = priv->spi; in mcp251x_restart_work_handler() local
1027 struct net_device *net = priv->net; in mcp251x_restart_work_handler()
1029 mutex_lock(&priv->mcp_lock); in mcp251x_restart_work_handler()
1030 if (priv->after_suspend) { in mcp251x_restart_work_handler()
1031 if (priv->after_suspend & AFTER_SUSPEND_POWER) { in mcp251x_restart_work_handler()
1032 mcp251x_hw_reset(spi); in mcp251x_restart_work_handler()
1033 mcp251x_setup(net, spi); in mcp251x_restart_work_handler()
1034 mcp251x_gpio_restore(spi); in mcp251x_restart_work_handler()
1036 mcp251x_hw_wake(spi); in mcp251x_restart_work_handler()
1038 priv->force_quit = 0; in mcp251x_restart_work_handler()
1039 if (priv->after_suspend & AFTER_SUSPEND_RESTART) { in mcp251x_restart_work_handler()
1040 mcp251x_set_normal_mode(spi); in mcp251x_restart_work_handler()
1041 } else if (priv->after_suspend & AFTER_SUSPEND_UP) { in mcp251x_restart_work_handler()
1044 mcp251x_set_normal_mode(spi); in mcp251x_restart_work_handler()
1047 mcp251x_hw_sleep(spi); in mcp251x_restart_work_handler()
1049 priv->after_suspend = 0; in mcp251x_restart_work_handler()
1052 if (priv->restart_tx) { in mcp251x_restart_work_handler()
1053 priv->restart_tx = 0; in mcp251x_restart_work_handler()
1054 mcp251x_write_reg(spi, TXBCTRL(0), 0); in mcp251x_restart_work_handler()
1059 mutex_unlock(&priv->mcp_lock); in mcp251x_restart_work_handler()
1065 struct spi_device *spi = priv->spi; in mcp251x_can_ist() local
1066 struct net_device *net = priv->net; in mcp251x_can_ist()
1068 mutex_lock(&priv->mcp_lock); in mcp251x_can_ist()
1069 while (!priv->force_quit) { in mcp251x_can_ist()
1075 mcp251x_read_2regs(spi, CANINTF, &intf, &eflag); in mcp251x_can_ist()
1082 mcp251x_hw_rx(spi, 0); in mcp251x_can_ist()
1086 if (mcp251x_is_2510(spi)) in mcp251x_can_ist()
1087 mcp251x_write_bits(spi, CANINTF, in mcp251x_can_ist()
1093 mcp251x_hw_rx(spi, 1); in mcp251x_can_ist()
1095 if (mcp251x_is_2510(spi)) in mcp251x_can_ist()
1103 mcp251x_write_bits(spi, CANINTF, clear_intf, 0x00); in mcp251x_can_ist()
1106 mcp251x_write_bits(spi, EFLG, eflag, 0x00); in mcp251x_can_ist()
1133 switch (priv->can.state) { in mcp251x_can_ist()
1137 priv->can.can_stats.error_warning++; in mcp251x_can_ist()
1142 priv->can.can_stats.error_passive++; in mcp251x_can_ist()
1147 priv->can.state = new_state; in mcp251x_can_ist()
1153 net->stats.rx_over_errors++; in mcp251x_can_ist()
1154 net->stats.rx_errors++; in mcp251x_can_ist()
1157 net->stats.rx_over_errors++; in mcp251x_can_ist()
1158 net->stats.rx_errors++; in mcp251x_can_ist()
1166 if (priv->can.state == CAN_STATE_BUS_OFF) { in mcp251x_can_ist()
1167 if (priv->can.restart_ms == 0) { in mcp251x_can_ist()
1168 priv->force_quit = 1; in mcp251x_can_ist()
1169 priv->can.can_stats.bus_off++; in mcp251x_can_ist()
1171 mcp251x_hw_sleep(spi); in mcp251x_can_ist()
1180 net->stats.tx_packets++; in mcp251x_can_ist()
1181 net->stats.tx_bytes += priv->tx_len - 1; in mcp251x_can_ist()
1183 if (priv->tx_len) { in mcp251x_can_ist()
1185 priv->tx_len = 0; in mcp251x_can_ist()
1190 mutex_unlock(&priv->mcp_lock); in mcp251x_can_ist()
1197 struct spi_device *spi = priv->spi; in mcp251x_open() local
1203 dev_err(&spi->dev, "unable to set initial baudrate!\n"); in mcp251x_open()
1207 mutex_lock(&priv->mcp_lock); in mcp251x_open()
1208 mcp251x_power_enable(priv->transceiver, 1); in mcp251x_open()
1210 priv->force_quit = 0; in mcp251x_open()
1211 priv->tx_skb = NULL; in mcp251x_open()
1212 priv->tx_len = 0; in mcp251x_open()
1214 if (!dev_fwnode(&spi->dev)) in mcp251x_open()
1217 ret = request_threaded_irq(spi->irq, NULL, mcp251x_can_ist, in mcp251x_open()
1218 flags | IRQF_ONESHOT, dev_name(&spi->dev), in mcp251x_open()
1221 dev_err(&spi->dev, "failed to acquire irq %d\n", spi->irq); in mcp251x_open()
1225 ret = mcp251x_hw_wake(spi); in mcp251x_open()
1228 ret = mcp251x_setup(net, spi); in mcp251x_open()
1231 ret = mcp251x_set_normal_mode(spi); in mcp251x_open()
1238 mutex_unlock(&priv->mcp_lock); in mcp251x_open()
1243 free_irq(spi->irq, priv); in mcp251x_open()
1244 mcp251x_hw_sleep(spi); in mcp251x_open()
1246 mcp251x_power_enable(priv->transceiver, 0); in mcp251x_open()
1248 mutex_unlock(&priv->mcp_lock); in mcp251x_open()
1291 MODULE_DEVICE_TABLE(spi, mcp251x_id_table);
1293 static int mcp251x_can_probe(struct spi_device *spi) in mcp251x_can_probe() argument
1295 const void *match = device_get_match_data(&spi->dev); in mcp251x_can_probe()
1302 clk = devm_clk_get_optional(&spi->dev, NULL); in mcp251x_can_probe()
1308 device_property_read_u32(&spi->dev, "clock-frequency", &freq); in mcp251x_can_probe()
1312 return -ERANGE; in mcp251x_can_probe()
1317 return -ENOMEM; in mcp251x_can_probe()
1323 net->netdev_ops = &mcp251x_netdev_ops; in mcp251x_can_probe()
1324 net->flags |= IFF_ECHO; in mcp251x_can_probe()
1327 priv->can.bittiming_const = &mcp251x_bittiming_const; in mcp251x_can_probe()
1328 priv->can.do_set_mode = mcp251x_do_set_mode; in mcp251x_can_probe()
1329 priv->can.clock.freq = freq / 2; in mcp251x_can_probe()
1330 priv->can.ctrlmode_supported = CAN_CTRLMODE_3_SAMPLES | in mcp251x_can_probe()
1333 priv->model = (enum mcp251x_model)(uintptr_t)match; in mcp251x_can_probe()
1335 priv->model = spi_get_device_id(spi)->driver_data; in mcp251x_can_probe()
1336 priv->net = net; in mcp251x_can_probe()
1337 priv->clk = clk; in mcp251x_can_probe()
1339 spi_set_drvdata(spi, priv); in mcp251x_can_probe()
1341 /* Configure the SPI bus */ in mcp251x_can_probe()
1342 spi->bits_per_word = 8; in mcp251x_can_probe()
1343 if (mcp251x_is_2510(spi)) in mcp251x_can_probe()
1344 spi->max_speed_hz = spi->max_speed_hz ? : 5 * 1000 * 1000; in mcp251x_can_probe()
1346 spi->max_speed_hz = spi->max_speed_hz ? : 10 * 1000 * 1000; in mcp251x_can_probe()
1347 ret = spi_setup(spi); in mcp251x_can_probe()
1351 priv->power = devm_regulator_get_optional(&spi->dev, "vdd"); in mcp251x_can_probe()
1352 priv->transceiver = devm_regulator_get_optional(&spi->dev, "xceiver"); in mcp251x_can_probe()
1353 if ((PTR_ERR(priv->power) == -EPROBE_DEFER) || in mcp251x_can_probe()
1354 (PTR_ERR(priv->transceiver) == -EPROBE_DEFER)) { in mcp251x_can_probe()
1355 ret = -EPROBE_DEFER; in mcp251x_can_probe()
1359 ret = mcp251x_power_enable(priv->power, 1); in mcp251x_can_probe()
1363 priv->wq = alloc_workqueue("mcp251x_wq", WQ_FREEZABLE | WQ_MEM_RECLAIM, in mcp251x_can_probe()
1365 if (!priv->wq) { in mcp251x_can_probe()
1366 ret = -ENOMEM; in mcp251x_can_probe()
1369 INIT_WORK(&priv->tx_work, mcp251x_tx_work_handler); in mcp251x_can_probe()
1370 INIT_WORK(&priv->restart_work, mcp251x_restart_work_handler); in mcp251x_can_probe()
1372 priv->spi = spi; in mcp251x_can_probe()
1373 mutex_init(&priv->mcp_lock); in mcp251x_can_probe()
1375 priv->spi_tx_buf = devm_kzalloc(&spi->dev, SPI_TRANSFER_BUF_LEN, in mcp251x_can_probe()
1377 if (!priv->spi_tx_buf) { in mcp251x_can_probe()
1378 ret = -ENOMEM; in mcp251x_can_probe()
1382 priv->spi_rx_buf = devm_kzalloc(&spi->dev, SPI_TRANSFER_BUF_LEN, in mcp251x_can_probe()
1384 if (!priv->spi_rx_buf) { in mcp251x_can_probe()
1385 ret = -ENOMEM; in mcp251x_can_probe()
1389 SET_NETDEV_DEV(net, &spi->dev); in mcp251x_can_probe()
1392 ret = mcp251x_hw_probe(spi); in mcp251x_can_probe()
1394 if (ret == -ENODEV) in mcp251x_can_probe()
1395 dev_err(&spi->dev, "Cannot initialize MCP%x. Wrong wiring?\n", in mcp251x_can_probe()
1396 priv->model); in mcp251x_can_probe()
1400 mcp251x_hw_sleep(spi); in mcp251x_can_probe()
1412 netdev_info(net, "MCP%x successfully initialized.\n", priv->model); in mcp251x_can_probe()
1416 destroy_workqueue(priv->wq); in mcp251x_can_probe()
1417 priv->wq = NULL; in mcp251x_can_probe()
1418 mcp251x_power_enable(priv->power, 0); in mcp251x_can_probe()
1426 dev_err(&spi->dev, "Probe failed, err=%d\n", -ret); in mcp251x_can_probe()
1430 static int mcp251x_can_remove(struct spi_device *spi) in mcp251x_can_remove() argument
1432 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_can_remove()
1433 struct net_device *net = priv->net; in mcp251x_can_remove()
1437 mcp251x_power_enable(priv->power, 0); in mcp251x_can_remove()
1439 destroy_workqueue(priv->wq); in mcp251x_can_remove()
1440 priv->wq = NULL; in mcp251x_can_remove()
1442 clk_disable_unprepare(priv->clk); in mcp251x_can_remove()
1451 struct spi_device *spi = to_spi_device(dev); in mcp251x_can_suspend() local
1452 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_can_suspend()
1453 struct net_device *net = priv->net; in mcp251x_can_suspend()
1455 priv->force_quit = 1; in mcp251x_can_suspend()
1456 disable_irq(spi->irq); in mcp251x_can_suspend()
1463 mcp251x_hw_sleep(spi); in mcp251x_can_suspend()
1464 mcp251x_power_enable(priv->transceiver, 0); in mcp251x_can_suspend()
1465 priv->after_suspend = AFTER_SUSPEND_UP; in mcp251x_can_suspend()
1467 priv->after_suspend = AFTER_SUSPEND_DOWN; in mcp251x_can_suspend()
1470 mcp251x_power_enable(priv->power, 0); in mcp251x_can_suspend()
1471 priv->after_suspend |= AFTER_SUSPEND_POWER; in mcp251x_can_suspend()
1478 struct spi_device *spi = to_spi_device(dev); in mcp251x_can_resume() local
1479 struct mcp251x_priv *priv = spi_get_drvdata(spi); in mcp251x_can_resume()
1481 if (priv->after_suspend & AFTER_SUSPEND_POWER) in mcp251x_can_resume()
1482 mcp251x_power_enable(priv->power, 1); in mcp251x_can_resume()
1483 if (priv->after_suspend & AFTER_SUSPEND_UP) in mcp251x_can_resume()
1484 mcp251x_power_enable(priv->transceiver, 1); in mcp251x_can_resume()
1486 if (priv->after_suspend & (AFTER_SUSPEND_POWER | AFTER_SUSPEND_UP)) in mcp251x_can_resume()
1487 queue_work(priv->wq, &priv->restart_work); in mcp251x_can_resume()
1489 priv->after_suspend = 0; in mcp251x_can_resume()
1491 priv->force_quit = 0; in mcp251x_can_resume()
1492 enable_irq(spi->irq); in mcp251x_can_resume()