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