Commit bd573ea5 authored by Marc Kleine-Budde's avatar Marc Kleine-Budde

can: peak_usb: pcan_usb: replace open coded endianness conversion of unaligned data

This patch replaces the open coded endianness conversion of unaligned
data by the appropriate get/put_unaligned_leXX() variants.

Link: https://lore.kernel.org/r/20210406111622.1874957-11-mkl@pengutronix.deAcked-by: default avatarStephane Grosjean <s.grosjean@peak-system.com>
Tested-by: default avatarStephane Grosjean <s.grosjean@peak-system.com>
Signed-off-by: default avatarMarc Kleine-Budde <mkl@pengutronix.de>
parent b7a29d35
...@@ -394,14 +394,10 @@ static int pcan_usb_get_device_id(struct peak_usb_device *dev, u32 *device_id) ...@@ -394,14 +394,10 @@ static int pcan_usb_get_device_id(struct peak_usb_device *dev, u32 *device_id)
*/ */
static int pcan_usb_update_ts(struct pcan_usb_msg_context *mc) static int pcan_usb_update_ts(struct pcan_usb_msg_context *mc)
{ {
__le16 tmp16;
if ((mc->ptr + 2) > mc->end) if ((mc->ptr + 2) > mc->end)
return -EINVAL; return -EINVAL;
memcpy(&tmp16, mc->ptr, 2); mc->ts16 = get_unaligned_le16(mc->ptr);
mc->ts16 = le16_to_cpu(tmp16);
if (mc->rec_idx > 0) if (mc->rec_idx > 0)
peak_usb_update_ts_now(&mc->pdev->time_ref, mc->ts16); peak_usb_update_ts_now(&mc->pdev->time_ref, mc->ts16);
...@@ -418,16 +414,13 @@ static int pcan_usb_decode_ts(struct pcan_usb_msg_context *mc, u8 first_packet) ...@@ -418,16 +414,13 @@ static int pcan_usb_decode_ts(struct pcan_usb_msg_context *mc, u8 first_packet)
{ {
/* only 1st packet supplies a word timestamp */ /* only 1st packet supplies a word timestamp */
if (first_packet) { if (first_packet) {
__le16 tmp16;
if ((mc->ptr + 2) > mc->end) if ((mc->ptr + 2) > mc->end)
return -EINVAL; return -EINVAL;
memcpy(&tmp16, mc->ptr, 2); mc->ts16 = get_unaligned_le16(mc->ptr);
mc->ptr += 2;
mc->ts16 = le16_to_cpu(tmp16);
mc->prev_ts8 = mc->ts16 & 0x00ff; mc->prev_ts8 = mc->ts16 & 0x00ff;
mc->ptr += 2;
} else { } else {
u8 ts8; u8 ts8;
...@@ -717,25 +710,17 @@ static int pcan_usb_decode_data(struct pcan_usb_msg_context *mc, u8 status_len) ...@@ -717,25 +710,17 @@ static int pcan_usb_decode_data(struct pcan_usb_msg_context *mc, u8 status_len)
return -ENOMEM; return -ENOMEM;
if (status_len & PCAN_USB_STATUSLEN_EXT_ID) { if (status_len & PCAN_USB_STATUSLEN_EXT_ID) {
__le32 tmp32;
if ((mc->ptr + 4) > mc->end) if ((mc->ptr + 4) > mc->end)
goto decode_failed; goto decode_failed;
memcpy(&tmp32, mc->ptr, 4); cf->can_id = get_unaligned_le32(mc->ptr) >> 3 | CAN_EFF_FLAG;
mc->ptr += 4; mc->ptr += 4;
cf->can_id = (le32_to_cpu(tmp32) >> 3) | CAN_EFF_FLAG;
} else { } else {
__le16 tmp16;
if ((mc->ptr + 2) > mc->end) if ((mc->ptr + 2) > mc->end)
goto decode_failed; goto decode_failed;
memcpy(&tmp16, mc->ptr, 2); cf->can_id = get_unaligned_le16(mc->ptr) >> 5;
mc->ptr += 2; mc->ptr += 2;
cf->can_id = le16_to_cpu(tmp16) >> 5;
} }
can_frame_set_cc_len(cf, rec_len, mc->pdev->dev.can.ctrlmode); can_frame_set_cc_len(cf, rec_len, mc->pdev->dev.can.ctrlmode);
...@@ -849,15 +834,15 @@ static int pcan_usb_encode_msg(struct peak_usb_device *dev, struct sk_buff *skb, ...@@ -849,15 +834,15 @@ static int pcan_usb_encode_msg(struct peak_usb_device *dev, struct sk_buff *skb,
/* can id */ /* can id */
if (cf->can_id & CAN_EFF_FLAG) { if (cf->can_id & CAN_EFF_FLAG) {
__le32 tmp32 = cpu_to_le32((cf->can_id & CAN_ERR_MASK) << 3);
*pc |= PCAN_USB_STATUSLEN_EXT_ID; *pc |= PCAN_USB_STATUSLEN_EXT_ID;
memcpy(++pc, &tmp32, 4); pc++;
put_unaligned_le32((cf->can_id & CAN_ERR_MASK) << 3, pc);
pc += 4; pc += 4;
} else { } else {
__le16 tmp16 = cpu_to_le16((cf->can_id & CAN_ERR_MASK) << 5); pc++;
memcpy(++pc, &tmp16, 2); put_unaligned_le16((cf->can_id & CAN_ERR_MASK) << 5, pc);
pc += 2; pc += 2;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment