1 // SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0-only)
2 /* Copyright(c) 2014 - 2020 Intel Corporation */
3 #include <linux/types.h>
4 #include <linux/mutex.h>
5 #include <linux/slab.h>
6 #include <linux/iopoll.h>
8 #include <linux/dma-mapping.h>
9 #include "adf_accel_devices.h"
10 #include "adf_common_drv.h"
11 #include "icp_qat_fw_init_admin.h"
13 #define ADF_ADMIN_MAILBOX_STRIDE 0x1000
14 #define ADF_ADMINMSG_LEN 32
15 #define ADF_CONST_TABLE_SIZE 1024
16 #define ADF_ADMIN_POLL_DELAY_US 20
17 #define ADF_ADMIN_POLL_TIMEOUT_US (5 * USEC_PER_SEC)
19 static const u8 const_tab
[1024] __aligned(1024) = {
20 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
21 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
22 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
23 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
24 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
25 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
26 0x00, 0x00, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x00, 0x00,
27 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
28 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00,
29 0x00, 0x00, 0x00, 0x03, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x01,
30 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00,
31 0x00, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x13, 0x02, 0x00, 0x00,
32 0x00, 0x00, 0x00, 0x00, 0x13, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x13,
33 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x23, 0x00, 0x00, 0x00, 0x00, 0x00,
34 0x00, 0x00, 0x33, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x00, 0x00,
35 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
36 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
37 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
38 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
39 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
40 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
41 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
42 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00,
43 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
44 0x01, 0x23, 0x45, 0x67, 0x89, 0xab, 0xcd, 0xef, 0xfe, 0xdc, 0xba, 0x98, 0x76,
45 0x54, 0x32, 0x10, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
46 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x67, 0x45, 0x23, 0x01, 0xef, 0xcd, 0xab,
47 0x89, 0x98, 0xba, 0xdc, 0xfe, 0x10, 0x32, 0x54, 0x76, 0xc3, 0xd2, 0xe1, 0xf0,
48 0x00, 0x00, 0x00, 0x00, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
49 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00,
50 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc1, 0x05, 0x9e,
51 0xd8, 0x36, 0x7c, 0xd5, 0x07, 0x30, 0x70, 0xdd, 0x17, 0xf7, 0x0e, 0x59, 0x39,
52 0xff, 0xc0, 0x0b, 0x31, 0x68, 0x58, 0x15, 0x11, 0x64, 0xf9, 0x8f, 0xa7, 0xbe,
53 0xfa, 0x4f, 0xa4, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
54 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6a, 0x09, 0xe6, 0x67, 0xbb, 0x67, 0xae,
55 0x85, 0x3c, 0x6e, 0xf3, 0x72, 0xa5, 0x4f, 0xf5, 0x3a, 0x51, 0x0e, 0x52, 0x7f,
56 0x9b, 0x05, 0x68, 0x8c, 0x1f, 0x83, 0xd9, 0xab, 0x5b, 0xe0, 0xcd, 0x19, 0x05,
57 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
58 0x00, 0x00, 0xcb, 0xbb, 0x9d, 0x5d, 0xc1, 0x05, 0x9e, 0xd8, 0x62, 0x9a, 0x29,
59 0x2a, 0x36, 0x7c, 0xd5, 0x07, 0x91, 0x59, 0x01, 0x5a, 0x30, 0x70, 0xdd, 0x17,
60 0x15, 0x2f, 0xec, 0xd8, 0xf7, 0x0e, 0x59, 0x39, 0x67, 0x33, 0x26, 0x67, 0xff,
61 0xc0, 0x0b, 0x31, 0x8e, 0xb4, 0x4a, 0x87, 0x68, 0x58, 0x15, 0x11, 0xdb, 0x0c,
62 0x2e, 0x0d, 0x64, 0xf9, 0x8f, 0xa7, 0x47, 0xb5, 0x48, 0x1d, 0xbe, 0xfa, 0x4f,
63 0xa4, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
64 0x00, 0x00, 0x00, 0x00, 0x6a, 0x09, 0xe6, 0x67, 0xf3, 0xbc, 0xc9, 0x08, 0xbb,
65 0x67, 0xae, 0x85, 0x84, 0xca, 0xa7, 0x3b, 0x3c, 0x6e, 0xf3, 0x72, 0xfe, 0x94,
66 0xf8, 0x2b, 0xa5, 0x4f, 0xf5, 0x3a, 0x5f, 0x1d, 0x36, 0xf1, 0x51, 0x0e, 0x52,
67 0x7f, 0xad, 0xe6, 0x82, 0xd1, 0x9b, 0x05, 0x68, 0x8c, 0x2b, 0x3e, 0x6c, 0x1f,
68 0x1f, 0x83, 0xd9, 0xab, 0xfb, 0x41, 0xbd, 0x6b, 0x5b, 0xe0, 0xcd, 0x19, 0x13,
69 0x7e, 0x21, 0x79, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
70 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x16, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
71 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 0x12, 0x00, 0x00, 0x00,
72 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x18,
73 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
74 0x00, 0x00, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x14, 0x01, 0x00,
75 0x00, 0x00, 0x00, 0x00, 0x00, 0x15, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
76 0x15, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x14, 0x02, 0x00, 0x00, 0x00,
77 0x00, 0x00, 0x00, 0x14, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x15, 0x02,
78 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x15, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00,
79 0x00, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x25, 0x00, 0x00, 0x00,
80 0x00, 0x00, 0x00, 0x00, 0x24, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x25,
81 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x12, 0x00, 0x00, 0x00, 0x00, 0x00,
82 0x00, 0x00, 0x12, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x43, 0x00, 0x00,
83 0x00, 0x00, 0x00, 0x00, 0x00, 0x43, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
84 0x45, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x45, 0x01, 0x00, 0x00, 0x00,
85 0x00, 0x00, 0x00, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x44, 0x01,
86 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x2B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
87 0x00, 0x2B, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00,
88 0x00, 0x00, 0x00, 0x00, 0x15, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
89 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 0x17, 0x00, 0x00, 0x00, 0x00, 0x00,
90 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00,
91 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
92 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
93 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
94 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
95 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
96 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
97 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
98 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
100 struct adf_admin_comms
{
102 dma_addr_t const_tbl_addr
;
105 void __iomem
*mailbox_addr
;
106 struct mutex lock
; /* protects adf_admin_comms struct */
109 static int adf_put_admin_msg_sync(struct adf_accel_dev
*accel_dev
, u32 ae
,
114 struct adf_admin_comms
*admin
= accel_dev
->admin
;
115 int offset
= ae
* ADF_ADMINMSG_LEN
* 2;
116 void __iomem
*mailbox
= admin
->mailbox_addr
;
117 int mb_offset
= ae
* ADF_ADMIN_MAILBOX_STRIDE
;
118 struct icp_qat_fw_init_admin_req
*request
= in
;
120 mutex_lock(&admin
->lock
);
122 if (ADF_CSR_RD(mailbox
, mb_offset
) == 1) {
123 mutex_unlock(&admin
->lock
);
127 memcpy(admin
->virt_addr
+ offset
, in
, ADF_ADMINMSG_LEN
);
128 ADF_CSR_WR(mailbox
, mb_offset
, 1);
130 ret
= read_poll_timeout(ADF_CSR_RD
, status
, status
== 0,
131 ADF_ADMIN_POLL_DELAY_US
,
132 ADF_ADMIN_POLL_TIMEOUT_US
, true,
135 /* Response timeout */
136 dev_err(&GET_DEV(accel_dev
),
137 "Failed to send admin msg %d to accelerator %d\n",
138 request
->cmd_id
, ae
);
140 /* Response received from admin message, we can now
141 * make response data available in "out" parameter.
143 memcpy(out
, admin
->virt_addr
+ offset
+
144 ADF_ADMINMSG_LEN
, ADF_ADMINMSG_LEN
);
147 mutex_unlock(&admin
->lock
);
151 static int adf_send_admin(struct adf_accel_dev
*accel_dev
,
152 struct icp_qat_fw_init_admin_req
*req
,
153 struct icp_qat_fw_init_admin_resp
*resp
,
154 const unsigned long ae_mask
)
158 for_each_set_bit(ae
, &ae_mask
, ICP_QAT_HW_AE_DELIMITER
)
159 if (adf_put_admin_msg_sync(accel_dev
, ae
, req
, resp
) ||
166 static int adf_init_ae(struct adf_accel_dev
*accel_dev
)
168 struct icp_qat_fw_init_admin_req req
;
169 struct icp_qat_fw_init_admin_resp resp
;
170 struct adf_hw_device_data
*hw_device
= accel_dev
->hw_device
;
171 u32 ae_mask
= hw_device
->ae_mask
;
173 memset(&req
, 0, sizeof(req
));
174 memset(&resp
, 0, sizeof(resp
));
175 req
.cmd_id
= ICP_QAT_FW_INIT_AE
;
177 return adf_send_admin(accel_dev
, &req
, &resp
, ae_mask
);
180 static int adf_set_fw_constants(struct adf_accel_dev
*accel_dev
)
182 struct icp_qat_fw_init_admin_req req
;
183 struct icp_qat_fw_init_admin_resp resp
;
184 struct adf_hw_device_data
*hw_device
= accel_dev
->hw_device
;
185 u32 ae_mask
= hw_device
->admin_ae_mask
?: hw_device
->ae_mask
;
187 memset(&req
, 0, sizeof(req
));
188 memset(&resp
, 0, sizeof(resp
));
189 req
.cmd_id
= ICP_QAT_FW_CONSTANTS_CFG
;
191 req
.init_cfg_sz
= ADF_CONST_TABLE_SIZE
;
192 req
.init_cfg_ptr
= accel_dev
->admin
->const_tbl_addr
;
194 return adf_send_admin(accel_dev
, &req
, &resp
, ae_mask
);
198 * adf_send_admin_init() - Function sends init message to FW
199 * @accel_dev: Pointer to acceleration device.
201 * Function sends admin init message to the FW
203 * Return: 0 on success, error code otherwise.
205 int adf_send_admin_init(struct adf_accel_dev
*accel_dev
)
209 ret
= adf_set_fw_constants(accel_dev
);
213 return adf_init_ae(accel_dev
);
215 EXPORT_SYMBOL_GPL(adf_send_admin_init
);
217 int adf_init_admin_comms(struct adf_accel_dev
*accel_dev
)
219 struct adf_admin_comms
*admin
;
220 struct adf_hw_device_data
*hw_data
= accel_dev
->hw_device
;
221 struct adf_bar
*pmisc
=
222 &GET_BARS(accel_dev
)[hw_data
->get_misc_bar_id(hw_data
)];
223 void __iomem
*csr
= pmisc
->virt_addr
;
224 struct admin_info admin_csrs_info
;
225 u32 mailbox_offset
, adminmsg_u
, adminmsg_l
;
226 void __iomem
*mailbox
;
229 admin
= kzalloc_node(sizeof(*accel_dev
->admin
), GFP_KERNEL
,
230 dev_to_node(&GET_DEV(accel_dev
)));
233 admin
->virt_addr
= dma_alloc_coherent(&GET_DEV(accel_dev
), PAGE_SIZE
,
234 &admin
->phy_addr
, GFP_KERNEL
);
235 if (!admin
->virt_addr
) {
236 dev_err(&GET_DEV(accel_dev
), "Failed to allocate dma buff\n");
241 admin
->virt_tbl_addr
= dma_alloc_coherent(&GET_DEV(accel_dev
),
243 &admin
->const_tbl_addr
,
245 if (!admin
->virt_tbl_addr
) {
246 dev_err(&GET_DEV(accel_dev
), "Failed to allocate const_tbl\n");
247 dma_free_coherent(&GET_DEV(accel_dev
), PAGE_SIZE
,
248 admin
->virt_addr
, admin
->phy_addr
);
253 memcpy(admin
->virt_tbl_addr
, const_tab
, sizeof(const_tab
));
254 hw_data
->get_admin_info(&admin_csrs_info
);
256 mailbox_offset
= admin_csrs_info
.mailbox_offset
;
257 mailbox
= csr
+ mailbox_offset
;
258 adminmsg_u
= admin_csrs_info
.admin_msg_ur
;
259 adminmsg_l
= admin_csrs_info
.admin_msg_lr
;
261 reg_val
= (u64
)admin
->phy_addr
;
262 ADF_CSR_WR(csr
, adminmsg_u
, upper_32_bits(reg_val
));
263 ADF_CSR_WR(csr
, adminmsg_l
, lower_32_bits(reg_val
));
265 mutex_init(&admin
->lock
);
266 admin
->mailbox_addr
= mailbox
;
267 accel_dev
->admin
= admin
;
270 EXPORT_SYMBOL_GPL(adf_init_admin_comms
);
272 void adf_exit_admin_comms(struct adf_accel_dev
*accel_dev
)
274 struct adf_admin_comms
*admin
= accel_dev
->admin
;
279 if (admin
->virt_addr
)
280 dma_free_coherent(&GET_DEV(accel_dev
), PAGE_SIZE
,
281 admin
->virt_addr
, admin
->phy_addr
);
282 if (admin
->virt_tbl_addr
)
283 dma_free_coherent(&GET_DEV(accel_dev
), PAGE_SIZE
,
284 admin
->virt_tbl_addr
, admin
->const_tbl_addr
);
286 mutex_destroy(&admin
->lock
);
288 accel_dev
->admin
= NULL
;
290 EXPORT_SYMBOL_GPL(adf_exit_admin_comms
);