66 lines · c
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 */11DECLARE_CRC8_TABLE(pfvf_crc8_table);12#define ADF_PFVF_CRC8_POLYNOMIAL 0x9713 14void adf_pfvf_crc_init(void)15{16 crc8_populate_msb(pfvf_crc8_table, ADF_PFVF_CRC8_POLYNOMIAL);17}18 19u8 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 24static 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 39u32 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 52struct 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