77 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/* Copyright(c) 2023 Intel Corporation */3#include <linux/random.h>4 5#include "adf_admin.h"6#include "adf_common_drv.h"7#include "adf_heartbeat.h"8 9#define MAX_HB_TICKS 0xFFFFFFFF10 11static int adf_hb_set_timer_to_max(struct adf_accel_dev *accel_dev)12{13 struct adf_hw_device_data *hw_data = accel_dev->hw_device;14 15 accel_dev->heartbeat->hb_timer = 0;16 17 if (hw_data->stop_timer)18 hw_data->stop_timer(accel_dev);19 20 return adf_send_admin_hb_timer(accel_dev, MAX_HB_TICKS);21}22 23static void adf_set_hb_counters_fail(struct adf_accel_dev *accel_dev, u32 ae,24 u32 thr)25{26 struct hb_cnt_pair *stats = accel_dev->heartbeat->dma.virt_addr;27 struct adf_hw_device_data *hw_device = accel_dev->hw_device;28 const size_t max_aes = hw_device->get_num_aes(hw_device);29 const size_t hb_ctrs = hw_device->num_hb_ctrs;30 size_t thr_id = ae * hb_ctrs + thr;31 u16 num_rsp = stats[thr_id].resp_heartbeat_cnt;32 33 /*34 * Inject live.req != live.rsp and live.rsp == last.rsp35 * to trigger the heartbeat error detection36 */37 stats[thr_id].req_heartbeat_cnt++;38 stats += (max_aes * hb_ctrs);39 stats[thr_id].resp_heartbeat_cnt = num_rsp;40}41 42int adf_heartbeat_inject_error(struct adf_accel_dev *accel_dev)43{44 struct adf_hw_device_data *hw_device = accel_dev->hw_device;45 const size_t max_aes = hw_device->get_num_aes(hw_device);46 const size_t hb_ctrs = hw_device->num_hb_ctrs;47 u32 rand, rand_ae, rand_thr;48 unsigned long ae_mask;49 int ret;50 51 ae_mask = hw_device->ae_mask;52 53 do {54 /* Ensure we have a valid ae */55 get_random_bytes(&rand, sizeof(rand));56 rand_ae = rand % max_aes;57 } while (!test_bit(rand_ae, &ae_mask));58 59 get_random_bytes(&rand, sizeof(rand));60 rand_thr = rand % hb_ctrs;61 62 /* Increase the heartbeat timer to prevent FW updating HB counters */63 ret = adf_hb_set_timer_to_max(accel_dev);64 if (ret)65 return ret;66 67 /* Configure worker threads to stop processing any packet */68 ret = adf_disable_arb_thd(accel_dev, rand_ae, rand_thr);69 if (ret)70 return ret;71 72 /* Change HB counters memory to simulate a hang */73 adf_set_hb_counters_fail(accel_dev, rand_ae, rand_thr);74 75 return 0;76}77