1 // SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0-only)
2 /* Copyright(c) 2021 Intel Corporation */
3 #include <linux/crc8.h>
4 #include <linux/pci.h>
5 #include <linux/types.h>
6 #include "adf_accel_devices.h"
7 #include "adf_pfvf_msg.h"
8 #include "adf_pfvf_utils.h"
9
10 /* CRC Calculation */
11 DECLARE_CRC8_TABLE(pfvf_crc8_table);
12 #define ADF_PFVF_CRC8_POLYNOMIAL 0x97
13
adf_pfvf_crc_init(void)14 void adf_pfvf_crc_init(void)
15 {
16 crc8_populate_msb(pfvf_crc8_table, ADF_PFVF_CRC8_POLYNOMIAL);
17 }
18
adf_pfvf_calc_blkmsg_crc(u8 const * buf,u8 buf_len)19 u8 adf_pfvf_calc_blkmsg_crc(u8 const *buf, u8 buf_len)
20 {
21 return crc8(pfvf_crc8_table, buf, buf_len, CRC8_INIT_VALUE);
22 }
23
set_value_on_csr_msg(struct adf_accel_dev * accel_dev,u32 * csr_msg,u32 value,const struct pfvf_field_format * fmt)24 static bool set_value_on_csr_msg(struct adf_accel_dev *accel_dev, u32 *csr_msg,
25 u32 value, const struct pfvf_field_format *fmt)
26 {
27 if (unlikely((value & fmt->mask) != value)) {
28 dev_err(&GET_DEV(accel_dev),
29 "PFVF message value 0x%X out of range, %u max allowed\n",
30 value, fmt->mask);
31 return false;
32 }
33
34 *csr_msg |= value << fmt->offset;
35
36 return true;
37 }
38
adf_pfvf_csr_msg_of(struct adf_accel_dev * accel_dev,struct pfvf_message msg,const struct pfvf_csr_format * fmt)39 u32 adf_pfvf_csr_msg_of(struct adf_accel_dev *accel_dev,
40 struct pfvf_message msg,
41 const struct pfvf_csr_format *fmt)
42 {
43 u32 csr_msg = 0;
44
45 if (!set_value_on_csr_msg(accel_dev, &csr_msg, msg.type, &fmt->type) ||
46 !set_value_on_csr_msg(accel_dev, &csr_msg, msg.data, &fmt->data))
47 return 0;
48
49 return csr_msg | ADF_PFVF_MSGORIGIN_SYSTEM;
50 }
51
adf_pfvf_message_of(struct adf_accel_dev * accel_dev,u32 csr_msg,const struct pfvf_csr_format * fmt)52 struct pfvf_message adf_pfvf_message_of(struct adf_accel_dev *accel_dev, u32 csr_msg,
53 const struct pfvf_csr_format *fmt)
54 {
55 struct pfvf_message msg = { 0 };
56
57 msg.type = (csr_msg >> fmt->type.offset) & fmt->type.mask;
58 msg.data = (csr_msg >> fmt->data.offset) & fmt->data.mask;
59
60 if (unlikely(!msg.type))
61 dev_err(&GET_DEV(accel_dev),
62 "Invalid PFVF msg with no type received\n");
63
64 return msg;
65 }
66