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
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.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
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