1 // SPDX-License-Identifier: GPL-2.0-only
2 /* 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 0xFFFFFFFF
10
adf_hb_set_timer_to_max(struct adf_accel_dev * accel_dev)11 static 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
adf_set_hb_counters_fail(struct adf_accel_dev * accel_dev,u32 ae,u32 thr)23 static 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.rsp
35 * to trigger the heartbeat error detection
36 */
37 stats[thr_id].req_heartbeat_cnt++;
38 stats += (max_aes * hb_ctrs);
39 stats[thr_id].resp_heartbeat_cnt = num_rsp;
40 }
41
adf_heartbeat_inject_error(struct adf_accel_dev * accel_dev)42 int 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