| 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 | |
|---|
| 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 | |
|---|
| 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 | |
|---|
| 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(buf: &rand, len: sizeof(rand)); |
|---|
| 56 | rand_ae = rand % max_aes; |
|---|
| 57 | } while (!test_bit(rand_ae, &ae_mask)); |
|---|
| 58 | |
|---|
| 59 | get_random_bytes(buf: &rand, len: 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, ae: rand_ae, thr: 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, ae: rand_ae, thr: rand_thr); |
|---|
| 74 | |
|---|
| 75 | return 0; |
|---|
| 76 | } |
|---|
| 77 | |
|---|
