Added support for listen only mode for CPC-USB/ARM7
Signed-off-by: Gerhard Uttenthaler <uttenthaler@xxxxxxxxxxxxxxxx>
---
drivers/net/can/usb/ems_usb.c | 35 ++++++++++++++++++++++-------------
1 file changed, 22 insertions(+), 13 deletions(-)
diff --git a/drivers/net/can/usb/ems_usb.c b/drivers/net/can/usb/ems_usb.c
index 3eb3698d5ae6..0e8d1b75ef8d 100644
--- a/drivers/net/can/usb/ems_usb.c
+++ b/drivers/net/can/usb/ems_usb.c
@@ -81,6 +81,7 @@ MODULE_LICENSE("GPL v2");
/* Mode register NXP LPC2119/SJA1000 CAN Controller */
#define SJA1000_MOD_NORMAL 0x00
#define SJA1000_MOD_RM 0x01
+#define SJA1000_MOD_LOM 0x02
/* ECC register NXP LPC2119/SJA1000 CAN Controller */
#define SJA1000_ECC_SEG 0x1F
@@ -600,13 +601,23 @@ static int ems_usb_write_mode_arm7(struct ems_usb *dev, u32 mode)
struct cpc_sja1000_params *sja1000 =
&dev->active_params.msg.can_params.cc_params.sja1000;
- if (mode == CPC_USB_RESET_MODE)
+ if (mode == CPC_USB_RESET_MODE) {
sja1000->mode |= SJA1000_MOD_RM;
- else if (mode == CPC_USB_RUN_MODE)
+ } else if (mode == CPC_USB_RUN_MODE) {
sja1000->mode &= ~SJA1000_MOD_RM;
- else
+ if (dev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY)
+ sja1000->mode |= SJA1000_MOD_LOM;
+ else
+ sja1000->mode &= ~SJA1000_MOD_LOM;
+
+ if (dev->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES)
+ sja1000->btr1 |= 0x80;
+ else
+ sja1000->btr1 &= ~0x80;
+ } else {
return -EINVAL;
+ }
return ems_usb_command_msg(dev, &dev->active_params);
}
@@ -978,14 +989,13 @@ static int ems_usb_set_bittiming_arm7(struct net_device *netdev)
{
struct ems_usb *dev = netdev_priv(netdev);
struct can_bittiming *bt = &dev->can.bittiming;
- u8 btr0, btr1;
+ struct cpc_sja1000_params *sja1000 =
+ &dev->active_params.msg.can_params.cc_params.sja1000;
int err;
- btr0 = ((bt->brp - 1) & 0x3f) | (((bt->sjw - 1) & 0x3) << 6);
- btr1 = ((bt->prop_seg + bt->phase_seg1 - 1) & 0xf) |
+ sja1000->btr0 = ((bt->brp - 1) & 0x3f) | (((bt->sjw - 1) & 0x3) << 6);
+ sja1000->btr1 = ((bt->prop_seg + bt->phase_seg1 - 1) & 0xf) |
(((bt->phase_seg2 - 1) & 0x7) << 4);
- if (dev->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES)
- btr1 |= 0x80;
/* If the command queue in the device is full with incoming commands
* a reinitialization would not be possible before the queue is cleared.
@@ -994,10 +1004,8 @@ static int ems_usb_set_bittiming_arm7(struct net_device *netdev)
if (err)
return err;
- netdev_info(netdev, "setting BTR0=0x%02x BTR1=0x%02x\n", btr0, btr1);
-
- dev->active_params.msg.can_params.cc_params.sja1000.btr0 = btr0;
- dev->active_params.msg.can_params.cc_params.sja1000.btr1 = btr1;
+ netdev_info(netdev, "Setting BTR0=0x%02x BTR1=0x%02x\n", sja1000->btr0,
+ sja1000->btr1);
return ems_usb_command_msg(dev, &dev->active_params);
}
@@ -1061,7 +1069,8 @@ static int ems_usb_probe(struct usb_interface *intf,
dev->can.bittiming_const = &ems_usb_bittiming_const_arm7;
dev->can.do_set_bittiming = ems_usb_set_bittiming_arm7;
dev->can.do_set_mode = ems_usb_set_mode;
- dev->can.ctrlmode_supported = CAN_CTRLMODE_3_SAMPLES;
+ dev->can.ctrlmode_supported = CAN_CTRLMODE_3_SAMPLES |
+ CAN_CTRLMODE_LISTENONLY;
init_params_sja1000(&dev->active_params);
dev->ems_usb_write_mode = ems_usb_write_mode_arm7;
dev->bulk_rd_buf_size = CPC_USB_ARM7_RX_BUFFER_SIZE;
--
2.26.2
--
EMS Dr. Thomas Wuensche e.K.
Sonnenhang 3
85304 Ilmmuenster
HR Ingolstadt, HRA 170106
Phone: +49-8441-490260
Fax : +49-8441-81860
http://www.ems-wuensche.com
