1d9110b0bSSrujanaChalla // SPDX-License-Identifier: GPL-2.0
2d9110b0bSSrujanaChalla /* Marvell OcteonTX CPT driver
3d9110b0bSSrujanaChalla  *
4d9110b0bSSrujanaChalla  * Copyright (C) 2019 Marvell International Ltd.
5d9110b0bSSrujanaChalla  *
6d9110b0bSSrujanaChalla  * This program is free software; you can redistribute it and/or modify
7d9110b0bSSrujanaChalla  * it under the terms of the GNU General Public License version 2 as
8d9110b0bSSrujanaChalla  * published by the Free Software Foundation.
9d9110b0bSSrujanaChalla  */
10d9110b0bSSrujanaChalla 
11d9110b0bSSrujanaChalla #include <linux/ctype.h>
12d9110b0bSSrujanaChalla #include <linux/firmware.h>
13d9110b0bSSrujanaChalla #include "otx_cpt_common.h"
14d9110b0bSSrujanaChalla #include "otx_cptpf_ucode.h"
15d9110b0bSSrujanaChalla #include "otx_cptpf.h"
16d9110b0bSSrujanaChalla 
17d9110b0bSSrujanaChalla #define CSR_DELAY 30
18d9110b0bSSrujanaChalla /* Tar archive defines */
19d9110b0bSSrujanaChalla #define TAR_MAGIC		"ustar"
20d9110b0bSSrujanaChalla #define TAR_MAGIC_LEN		6
21d9110b0bSSrujanaChalla #define TAR_BLOCK_LEN		512
22d9110b0bSSrujanaChalla #define REGTYPE			'0'
23d9110b0bSSrujanaChalla #define AREGTYPE		'\0'
24d9110b0bSSrujanaChalla 
25d9110b0bSSrujanaChalla /* tar header as defined in POSIX 1003.1-1990. */
26d9110b0bSSrujanaChalla struct tar_hdr_t {
27d9110b0bSSrujanaChalla 	char name[100];
28d9110b0bSSrujanaChalla 	char mode[8];
29d9110b0bSSrujanaChalla 	char uid[8];
30d9110b0bSSrujanaChalla 	char gid[8];
31d9110b0bSSrujanaChalla 	char size[12];
32d9110b0bSSrujanaChalla 	char mtime[12];
33d9110b0bSSrujanaChalla 	char chksum[8];
34d9110b0bSSrujanaChalla 	char typeflag;
35d9110b0bSSrujanaChalla 	char linkname[100];
36d9110b0bSSrujanaChalla 	char magic[6];
37d9110b0bSSrujanaChalla 	char version[2];
38d9110b0bSSrujanaChalla 	char uname[32];
39d9110b0bSSrujanaChalla 	char gname[32];
40d9110b0bSSrujanaChalla 	char devmajor[8];
41d9110b0bSSrujanaChalla 	char devminor[8];
42d9110b0bSSrujanaChalla 	char prefix[155];
43d9110b0bSSrujanaChalla };
44d9110b0bSSrujanaChalla 
45d9110b0bSSrujanaChalla struct tar_blk_t {
46d9110b0bSSrujanaChalla 	union {
47d9110b0bSSrujanaChalla 		struct tar_hdr_t hdr;
48d9110b0bSSrujanaChalla 		char block[TAR_BLOCK_LEN];
49d9110b0bSSrujanaChalla 	};
50d9110b0bSSrujanaChalla };
51d9110b0bSSrujanaChalla 
52d9110b0bSSrujanaChalla struct tar_arch_info_t {
53d9110b0bSSrujanaChalla 	struct list_head ucodes;
54d9110b0bSSrujanaChalla 	const struct firmware *fw;
55d9110b0bSSrujanaChalla };
56d9110b0bSSrujanaChalla 
get_cores_bmap(struct device * dev,struct otx_cpt_eng_grp_info * eng_grp)57d9110b0bSSrujanaChalla static struct otx_cpt_bitmap get_cores_bmap(struct device *dev,
58d9110b0bSSrujanaChalla 					   struct otx_cpt_eng_grp_info *eng_grp)
59d9110b0bSSrujanaChalla {
60d9110b0bSSrujanaChalla 	struct otx_cpt_bitmap bmap = { {0} };
61d9110b0bSSrujanaChalla 	bool found = false;
62d9110b0bSSrujanaChalla 	int i;
63d9110b0bSSrujanaChalla 
64d9110b0bSSrujanaChalla 	if (eng_grp->g->engs_num > OTX_CPT_MAX_ENGINES) {
650a8f5989SChristophe JAILLET 		dev_err(dev, "unsupported number of engines %d on octeontx\n",
66d9110b0bSSrujanaChalla 			eng_grp->g->engs_num);
67d9110b0bSSrujanaChalla 		return bmap;
68d9110b0bSSrujanaChalla 	}
69d9110b0bSSrujanaChalla 
70d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
71d9110b0bSSrujanaChalla 		if (eng_grp->engs[i].type) {
72d9110b0bSSrujanaChalla 			bitmap_or(bmap.bits, bmap.bits,
73d9110b0bSSrujanaChalla 				  eng_grp->engs[i].bmap,
74d9110b0bSSrujanaChalla 				  eng_grp->g->engs_num);
75d9110b0bSSrujanaChalla 			bmap.size = eng_grp->g->engs_num;
76d9110b0bSSrujanaChalla 			found = true;
77d9110b0bSSrujanaChalla 		}
78d9110b0bSSrujanaChalla 	}
79d9110b0bSSrujanaChalla 
80d9110b0bSSrujanaChalla 	if (!found)
810a8f5989SChristophe JAILLET 		dev_err(dev, "No engines reserved for engine group %d\n",
82d9110b0bSSrujanaChalla 			eng_grp->idx);
83d9110b0bSSrujanaChalla 	return bmap;
84d9110b0bSSrujanaChalla }
85d9110b0bSSrujanaChalla 
is_eng_type(int val,int eng_type)86d9110b0bSSrujanaChalla static int is_eng_type(int val, int eng_type)
87d9110b0bSSrujanaChalla {
88d9110b0bSSrujanaChalla 	return val & (1 << eng_type);
89d9110b0bSSrujanaChalla }
90d9110b0bSSrujanaChalla 
dev_supports_eng_type(struct otx_cpt_eng_grps * eng_grps,int eng_type)91d9110b0bSSrujanaChalla static int dev_supports_eng_type(struct otx_cpt_eng_grps *eng_grps,
92d9110b0bSSrujanaChalla 				 int eng_type)
93d9110b0bSSrujanaChalla {
94d9110b0bSSrujanaChalla 	return is_eng_type(eng_grps->eng_types_supported, eng_type);
95d9110b0bSSrujanaChalla }
96d9110b0bSSrujanaChalla 
set_ucode_filename(struct otx_cpt_ucode * ucode,const char * filename)97d9110b0bSSrujanaChalla static void set_ucode_filename(struct otx_cpt_ucode *ucode,
98d9110b0bSSrujanaChalla 			       const char *filename)
99d9110b0bSSrujanaChalla {
10028855860SWolfram Sang 	strscpy(ucode->filename, filename, OTX_CPT_UCODE_NAME_LENGTH);
101d9110b0bSSrujanaChalla }
102d9110b0bSSrujanaChalla 
get_eng_type_str(int eng_type)103d9110b0bSSrujanaChalla static char *get_eng_type_str(int eng_type)
104d9110b0bSSrujanaChalla {
105d9110b0bSSrujanaChalla 	char *str = "unknown";
106d9110b0bSSrujanaChalla 
107d9110b0bSSrujanaChalla 	switch (eng_type) {
108d9110b0bSSrujanaChalla 	case OTX_CPT_SE_TYPES:
109d9110b0bSSrujanaChalla 		str = "SE";
110d9110b0bSSrujanaChalla 		break;
111d9110b0bSSrujanaChalla 
112d9110b0bSSrujanaChalla 	case OTX_CPT_AE_TYPES:
113d9110b0bSSrujanaChalla 		str = "AE";
114d9110b0bSSrujanaChalla 		break;
115d9110b0bSSrujanaChalla 	}
116d9110b0bSSrujanaChalla 	return str;
117d9110b0bSSrujanaChalla }
118d9110b0bSSrujanaChalla 
get_ucode_type_str(int ucode_type)119d9110b0bSSrujanaChalla static char *get_ucode_type_str(int ucode_type)
120d9110b0bSSrujanaChalla {
121d9110b0bSSrujanaChalla 	char *str = "unknown";
122d9110b0bSSrujanaChalla 
123d9110b0bSSrujanaChalla 	switch (ucode_type) {
124d9110b0bSSrujanaChalla 	case (1 << OTX_CPT_SE_TYPES):
125d9110b0bSSrujanaChalla 		str = "SE";
126d9110b0bSSrujanaChalla 		break;
127d9110b0bSSrujanaChalla 
128d9110b0bSSrujanaChalla 	case (1 << OTX_CPT_AE_TYPES):
129d9110b0bSSrujanaChalla 		str = "AE";
130d9110b0bSSrujanaChalla 		break;
131d9110b0bSSrujanaChalla 	}
132d9110b0bSSrujanaChalla 	return str;
133d9110b0bSSrujanaChalla }
134d9110b0bSSrujanaChalla 
get_ucode_type(struct otx_cpt_ucode_hdr * ucode_hdr,int * ucode_type)135d9110b0bSSrujanaChalla static int get_ucode_type(struct otx_cpt_ucode_hdr *ucode_hdr, int *ucode_type)
136d9110b0bSSrujanaChalla {
137d9110b0bSSrujanaChalla 	char tmp_ver_str[OTX_CPT_UCODE_VER_STR_SZ];
138d9110b0bSSrujanaChalla 	u32 i, val = 0;
139d9110b0bSSrujanaChalla 	u8 nn;
140d9110b0bSSrujanaChalla 
14128855860SWolfram Sang 	strscpy(tmp_ver_str, ucode_hdr->ver_str, OTX_CPT_UCODE_VER_STR_SZ);
142d9110b0bSSrujanaChalla 	for (i = 0; i < strlen(tmp_ver_str); i++)
143d9110b0bSSrujanaChalla 		tmp_ver_str[i] = tolower(tmp_ver_str[i]);
144d9110b0bSSrujanaChalla 
145d9110b0bSSrujanaChalla 	nn = ucode_hdr->ver_num.nn;
146d9110b0bSSrujanaChalla 	if (strnstr(tmp_ver_str, "se-", OTX_CPT_UCODE_VER_STR_SZ) &&
147d9110b0bSSrujanaChalla 	    (nn == OTX_CPT_SE_UC_TYPE1 || nn == OTX_CPT_SE_UC_TYPE2 ||
148d9110b0bSSrujanaChalla 	     nn == OTX_CPT_SE_UC_TYPE3))
149d9110b0bSSrujanaChalla 		val |= 1 << OTX_CPT_SE_TYPES;
150d9110b0bSSrujanaChalla 	if (strnstr(tmp_ver_str, "ae", OTX_CPT_UCODE_VER_STR_SZ) &&
151d9110b0bSSrujanaChalla 	    nn == OTX_CPT_AE_UC_TYPE)
152d9110b0bSSrujanaChalla 		val |= 1 << OTX_CPT_AE_TYPES;
153d9110b0bSSrujanaChalla 
154d9110b0bSSrujanaChalla 	*ucode_type = val;
155d9110b0bSSrujanaChalla 
156d9110b0bSSrujanaChalla 	if (!val)
157d9110b0bSSrujanaChalla 		return -EINVAL;
158d9110b0bSSrujanaChalla 	if (is_eng_type(val, OTX_CPT_AE_TYPES) &&
159d9110b0bSSrujanaChalla 	    is_eng_type(val, OTX_CPT_SE_TYPES))
160d9110b0bSSrujanaChalla 		return -EINVAL;
161d9110b0bSSrujanaChalla 	return 0;
162d9110b0bSSrujanaChalla }
163d9110b0bSSrujanaChalla 
is_mem_zero(const char * ptr,int size)164d9110b0bSSrujanaChalla static int is_mem_zero(const char *ptr, int size)
165d9110b0bSSrujanaChalla {
166d9110b0bSSrujanaChalla 	int i;
167d9110b0bSSrujanaChalla 
168d9110b0bSSrujanaChalla 	for (i = 0; i < size; i++) {
169d9110b0bSSrujanaChalla 		if (ptr[i])
170d9110b0bSSrujanaChalla 			return 0;
171d9110b0bSSrujanaChalla 	}
172d9110b0bSSrujanaChalla 	return 1;
173d9110b0bSSrujanaChalla }
174d9110b0bSSrujanaChalla 
cpt_set_ucode_base(struct otx_cpt_eng_grp_info * eng_grp,void * obj)175d9110b0bSSrujanaChalla static int cpt_set_ucode_base(struct otx_cpt_eng_grp_info *eng_grp, void *obj)
176d9110b0bSSrujanaChalla {
177d9110b0bSSrujanaChalla 	struct otx_cpt_device *cpt = (struct otx_cpt_device *) obj;
178d9110b0bSSrujanaChalla 	dma_addr_t dma_addr;
179d9110b0bSSrujanaChalla 	struct otx_cpt_bitmap bmap;
180d9110b0bSSrujanaChalla 	int i;
181d9110b0bSSrujanaChalla 
182d9110b0bSSrujanaChalla 	bmap = get_cores_bmap(&cpt->pdev->dev, eng_grp);
183d9110b0bSSrujanaChalla 	if (!bmap.size)
184d9110b0bSSrujanaChalla 		return -EINVAL;
185d9110b0bSSrujanaChalla 
186d9110b0bSSrujanaChalla 	if (eng_grp->mirror.is_ena)
187d9110b0bSSrujanaChalla 		dma_addr =
188d9110b0bSSrujanaChalla 		       eng_grp->g->grp[eng_grp->mirror.idx].ucode[0].align_dma;
189d9110b0bSSrujanaChalla 	else
190d9110b0bSSrujanaChalla 		dma_addr = eng_grp->ucode[0].align_dma;
191d9110b0bSSrujanaChalla 
192d9110b0bSSrujanaChalla 	/*
193d9110b0bSSrujanaChalla 	 * Set UCODE_BASE only for the cores which are not used,
194d9110b0bSSrujanaChalla 	 * other cores should have already valid UCODE_BASE set
195d9110b0bSSrujanaChalla 	 */
196d9110b0bSSrujanaChalla 	for_each_set_bit(i, bmap.bits, bmap.size)
197d9110b0bSSrujanaChalla 		if (!eng_grp->g->eng_ref_cnt[i])
198d9110b0bSSrujanaChalla 			writeq((u64) dma_addr, cpt->reg_base +
199d9110b0bSSrujanaChalla 				OTX_CPT_PF_ENGX_UCODE_BASE(i));
200d9110b0bSSrujanaChalla 	return 0;
201d9110b0bSSrujanaChalla }
202d9110b0bSSrujanaChalla 
cpt_detach_and_disable_cores(struct otx_cpt_eng_grp_info * eng_grp,void * obj)203d9110b0bSSrujanaChalla static int cpt_detach_and_disable_cores(struct otx_cpt_eng_grp_info *eng_grp,
204d9110b0bSSrujanaChalla 					void *obj)
205d9110b0bSSrujanaChalla {
206d9110b0bSSrujanaChalla 	struct otx_cpt_device *cpt = (struct otx_cpt_device *) obj;
207d9110b0bSSrujanaChalla 	struct otx_cpt_bitmap bmap = { {0} };
208d9110b0bSSrujanaChalla 	int timeout = 10;
209d9110b0bSSrujanaChalla 	int i, busy;
210d9110b0bSSrujanaChalla 	u64 reg;
211d9110b0bSSrujanaChalla 
212d9110b0bSSrujanaChalla 	bmap = get_cores_bmap(&cpt->pdev->dev, eng_grp);
213d9110b0bSSrujanaChalla 	if (!bmap.size)
214d9110b0bSSrujanaChalla 		return -EINVAL;
215d9110b0bSSrujanaChalla 
216d9110b0bSSrujanaChalla 	/* Detach the cores from group */
217d9110b0bSSrujanaChalla 	reg = readq(cpt->reg_base + OTX_CPT_PF_GX_EN(eng_grp->idx));
218d9110b0bSSrujanaChalla 	for_each_set_bit(i, bmap.bits, bmap.size) {
219d9110b0bSSrujanaChalla 		if (reg & (1ull << i)) {
220d9110b0bSSrujanaChalla 			eng_grp->g->eng_ref_cnt[i]--;
221d9110b0bSSrujanaChalla 			reg &= ~(1ull << i);
222d9110b0bSSrujanaChalla 		}
223d9110b0bSSrujanaChalla 	}
224d9110b0bSSrujanaChalla 	writeq(reg, cpt->reg_base + OTX_CPT_PF_GX_EN(eng_grp->idx));
225d9110b0bSSrujanaChalla 
226d9110b0bSSrujanaChalla 	/* Wait for cores to become idle */
227d9110b0bSSrujanaChalla 	do {
228d9110b0bSSrujanaChalla 		busy = 0;
229d9110b0bSSrujanaChalla 		usleep_range(10000, 20000);
230d9110b0bSSrujanaChalla 		if (timeout-- < 0)
231d9110b0bSSrujanaChalla 			return -EBUSY;
232d9110b0bSSrujanaChalla 
233d9110b0bSSrujanaChalla 		reg = readq(cpt->reg_base + OTX_CPT_PF_EXEC_BUSY);
234d9110b0bSSrujanaChalla 		for_each_set_bit(i, bmap.bits, bmap.size)
235d9110b0bSSrujanaChalla 			if (reg & (1ull << i)) {
236d9110b0bSSrujanaChalla 				busy = 1;
237d9110b0bSSrujanaChalla 				break;
238d9110b0bSSrujanaChalla 			}
239d9110b0bSSrujanaChalla 	} while (busy);
240d9110b0bSSrujanaChalla 
241d9110b0bSSrujanaChalla 	/* Disable the cores only if they are not used anymore */
242d9110b0bSSrujanaChalla 	reg = readq(cpt->reg_base + OTX_CPT_PF_EXE_CTL);
243d9110b0bSSrujanaChalla 	for_each_set_bit(i, bmap.bits, bmap.size)
244d9110b0bSSrujanaChalla 		if (!eng_grp->g->eng_ref_cnt[i])
245d9110b0bSSrujanaChalla 			reg &= ~(1ull << i);
246d9110b0bSSrujanaChalla 	writeq(reg, cpt->reg_base + OTX_CPT_PF_EXE_CTL);
247d9110b0bSSrujanaChalla 
248d9110b0bSSrujanaChalla 	return 0;
249d9110b0bSSrujanaChalla }
250d9110b0bSSrujanaChalla 
cpt_attach_and_enable_cores(struct otx_cpt_eng_grp_info * eng_grp,void * obj)251d9110b0bSSrujanaChalla static int cpt_attach_and_enable_cores(struct otx_cpt_eng_grp_info *eng_grp,
252d9110b0bSSrujanaChalla 				       void *obj)
253d9110b0bSSrujanaChalla {
254d9110b0bSSrujanaChalla 	struct otx_cpt_device *cpt = (struct otx_cpt_device *) obj;
255d9110b0bSSrujanaChalla 	struct otx_cpt_bitmap bmap;
256d9110b0bSSrujanaChalla 	u64 reg;
257d9110b0bSSrujanaChalla 	int i;
258d9110b0bSSrujanaChalla 
259d9110b0bSSrujanaChalla 	bmap = get_cores_bmap(&cpt->pdev->dev, eng_grp);
260d9110b0bSSrujanaChalla 	if (!bmap.size)
261d9110b0bSSrujanaChalla 		return -EINVAL;
262d9110b0bSSrujanaChalla 
263d9110b0bSSrujanaChalla 	/* Attach the cores to the group */
264d9110b0bSSrujanaChalla 	reg = readq(cpt->reg_base + OTX_CPT_PF_GX_EN(eng_grp->idx));
265d9110b0bSSrujanaChalla 	for_each_set_bit(i, bmap.bits, bmap.size) {
266d9110b0bSSrujanaChalla 		if (!(reg & (1ull << i))) {
267d9110b0bSSrujanaChalla 			eng_grp->g->eng_ref_cnt[i]++;
268d9110b0bSSrujanaChalla 			reg |= 1ull << i;
269d9110b0bSSrujanaChalla 		}
270d9110b0bSSrujanaChalla 	}
271d9110b0bSSrujanaChalla 	writeq(reg, cpt->reg_base + OTX_CPT_PF_GX_EN(eng_grp->idx));
272d9110b0bSSrujanaChalla 
273d9110b0bSSrujanaChalla 	/* Enable the cores */
274d9110b0bSSrujanaChalla 	reg = readq(cpt->reg_base + OTX_CPT_PF_EXE_CTL);
275d9110b0bSSrujanaChalla 	for_each_set_bit(i, bmap.bits, bmap.size)
276d9110b0bSSrujanaChalla 		reg |= 1ull << i;
277d9110b0bSSrujanaChalla 	writeq(reg, cpt->reg_base + OTX_CPT_PF_EXE_CTL);
278d9110b0bSSrujanaChalla 
279d9110b0bSSrujanaChalla 	return 0;
280d9110b0bSSrujanaChalla }
281d9110b0bSSrujanaChalla 
process_tar_file(struct device * dev,struct tar_arch_info_t * tar_arch,char * filename,const u8 * data,u32 size)282d9110b0bSSrujanaChalla static int process_tar_file(struct device *dev,
283d9110b0bSSrujanaChalla 			    struct tar_arch_info_t *tar_arch, char *filename,
284d9110b0bSSrujanaChalla 			    const u8 *data, u32 size)
285d9110b0bSSrujanaChalla {
286d9110b0bSSrujanaChalla 	struct tar_ucode_info_t *tar_info;
287d9110b0bSSrujanaChalla 	struct otx_cpt_ucode_hdr *ucode_hdr;
288d9110b0bSSrujanaChalla 	int ucode_type, ucode_size;
289*caca37cfSDan Carpenter 	unsigned int code_length;
290d9110b0bSSrujanaChalla 
291d9110b0bSSrujanaChalla 	/*
292d9110b0bSSrujanaChalla 	 * If size is less than microcode header size then don't report
293d9110b0bSSrujanaChalla 	 * an error because it might not be microcode file, just process
294d9110b0bSSrujanaChalla 	 * next file from archive
295d9110b0bSSrujanaChalla 	 */
296d9110b0bSSrujanaChalla 	if (size < sizeof(struct otx_cpt_ucode_hdr))
297d9110b0bSSrujanaChalla 		return 0;
298d9110b0bSSrujanaChalla 
299d9110b0bSSrujanaChalla 	ucode_hdr = (struct otx_cpt_ucode_hdr *) data;
300d9110b0bSSrujanaChalla 	/*
301d9110b0bSSrujanaChalla 	 * If microcode version can't be found don't report an error
302d9110b0bSSrujanaChalla 	 * because it might not be microcode file, just process next file
303d9110b0bSSrujanaChalla 	 */
304d9110b0bSSrujanaChalla 	if (get_ucode_type(ucode_hdr, &ucode_type))
305d9110b0bSSrujanaChalla 		return 0;
306d9110b0bSSrujanaChalla 
307*caca37cfSDan Carpenter 	code_length = ntohl(ucode_hdr->code_length);
308*caca37cfSDan Carpenter 	if (code_length >= INT_MAX / 2) {
309*caca37cfSDan Carpenter 		dev_err(dev, "Invalid code_length %u\n", code_length);
310*caca37cfSDan Carpenter 		return -EINVAL;
311*caca37cfSDan Carpenter 	}
312*caca37cfSDan Carpenter 
313*caca37cfSDan Carpenter 	ucode_size = code_length * 2;
314d9110b0bSSrujanaChalla 	if (!ucode_size || (size < round_up(ucode_size, 16) +
315d9110b0bSSrujanaChalla 	    sizeof(struct otx_cpt_ucode_hdr) + OTX_CPT_UCODE_SIGN_LEN)) {
3160a8f5989SChristophe JAILLET 		dev_err(dev, "Ucode %s invalid size\n", filename);
317d9110b0bSSrujanaChalla 		return -EINVAL;
318d9110b0bSSrujanaChalla 	}
319d9110b0bSSrujanaChalla 
320d9110b0bSSrujanaChalla 	tar_info = kzalloc(sizeof(struct tar_ucode_info_t), GFP_KERNEL);
321d9110b0bSSrujanaChalla 	if (!tar_info)
322d9110b0bSSrujanaChalla 		return -ENOMEM;
323d9110b0bSSrujanaChalla 
324d9110b0bSSrujanaChalla 	tar_info->ucode_ptr = data;
325d9110b0bSSrujanaChalla 	set_ucode_filename(&tar_info->ucode, filename);
326d9110b0bSSrujanaChalla 	memcpy(tar_info->ucode.ver_str, ucode_hdr->ver_str,
327d9110b0bSSrujanaChalla 	       OTX_CPT_UCODE_VER_STR_SZ);
328d9110b0bSSrujanaChalla 	tar_info->ucode.ver_num = ucode_hdr->ver_num;
329d9110b0bSSrujanaChalla 	tar_info->ucode.type = ucode_type;
330d9110b0bSSrujanaChalla 	tar_info->ucode.size = ucode_size;
331d9110b0bSSrujanaChalla 	list_add_tail(&tar_info->list, &tar_arch->ucodes);
332d9110b0bSSrujanaChalla 
333d9110b0bSSrujanaChalla 	return 0;
334d9110b0bSSrujanaChalla }
335d9110b0bSSrujanaChalla 
release_tar_archive(struct tar_arch_info_t * tar_arch)336d9110b0bSSrujanaChalla static void release_tar_archive(struct tar_arch_info_t *tar_arch)
337d9110b0bSSrujanaChalla {
338d9110b0bSSrujanaChalla 	struct tar_ucode_info_t *curr, *temp;
339d9110b0bSSrujanaChalla 
340d9110b0bSSrujanaChalla 	if (!tar_arch)
341d9110b0bSSrujanaChalla 		return;
342d9110b0bSSrujanaChalla 
343d9110b0bSSrujanaChalla 	list_for_each_entry_safe(curr, temp, &tar_arch->ucodes, list) {
344d9110b0bSSrujanaChalla 		list_del(&curr->list);
345d9110b0bSSrujanaChalla 		kfree(curr);
346d9110b0bSSrujanaChalla 	}
347d9110b0bSSrujanaChalla 
348d9110b0bSSrujanaChalla 	release_firmware(tar_arch->fw);
349d9110b0bSSrujanaChalla 	kfree(tar_arch);
350d9110b0bSSrujanaChalla }
351d9110b0bSSrujanaChalla 
get_uc_from_tar_archive(struct tar_arch_info_t * tar_arch,int ucode_type)352d9110b0bSSrujanaChalla static struct tar_ucode_info_t *get_uc_from_tar_archive(
353d9110b0bSSrujanaChalla 					struct tar_arch_info_t *tar_arch,
354d9110b0bSSrujanaChalla 					int ucode_type)
355d9110b0bSSrujanaChalla {
356d9110b0bSSrujanaChalla 	struct tar_ucode_info_t *curr, *uc_found = NULL;
357d9110b0bSSrujanaChalla 
358d9110b0bSSrujanaChalla 	list_for_each_entry(curr, &tar_arch->ucodes, list) {
359d9110b0bSSrujanaChalla 		if (!is_eng_type(curr->ucode.type, ucode_type))
360d9110b0bSSrujanaChalla 			continue;
361d9110b0bSSrujanaChalla 
362d9110b0bSSrujanaChalla 		if (!uc_found) {
363d9110b0bSSrujanaChalla 			uc_found = curr;
364d9110b0bSSrujanaChalla 			continue;
365d9110b0bSSrujanaChalla 		}
366d9110b0bSSrujanaChalla 
367d9110b0bSSrujanaChalla 		switch (ucode_type) {
368d9110b0bSSrujanaChalla 		case OTX_CPT_AE_TYPES:
369d9110b0bSSrujanaChalla 			break;
370d9110b0bSSrujanaChalla 
371d9110b0bSSrujanaChalla 		case OTX_CPT_SE_TYPES:
372d9110b0bSSrujanaChalla 			if (uc_found->ucode.ver_num.nn == OTX_CPT_SE_UC_TYPE2 ||
373d9110b0bSSrujanaChalla 			    (uc_found->ucode.ver_num.nn == OTX_CPT_SE_UC_TYPE3
374d9110b0bSSrujanaChalla 			     && curr->ucode.ver_num.nn == OTX_CPT_SE_UC_TYPE1))
375d9110b0bSSrujanaChalla 				uc_found = curr;
376d9110b0bSSrujanaChalla 			break;
377d9110b0bSSrujanaChalla 		}
378d9110b0bSSrujanaChalla 	}
379d9110b0bSSrujanaChalla 
380d9110b0bSSrujanaChalla 	return uc_found;
381d9110b0bSSrujanaChalla }
382d9110b0bSSrujanaChalla 
print_tar_dbg_info(struct tar_arch_info_t * tar_arch,char * tar_filename)383d9110b0bSSrujanaChalla static void print_tar_dbg_info(struct tar_arch_info_t *tar_arch,
384d9110b0bSSrujanaChalla 			       char *tar_filename)
385d9110b0bSSrujanaChalla {
386d9110b0bSSrujanaChalla 	struct tar_ucode_info_t *curr;
387d9110b0bSSrujanaChalla 
3880a8f5989SChristophe JAILLET 	pr_debug("Tar archive filename %s\n", tar_filename);
3890a8f5989SChristophe JAILLET 	pr_debug("Tar archive pointer %p, size %ld\n", tar_arch->fw->data,
390d9110b0bSSrujanaChalla 		 tar_arch->fw->size);
391d9110b0bSSrujanaChalla 	list_for_each_entry(curr, &tar_arch->ucodes, list) {
3920a8f5989SChristophe JAILLET 		pr_debug("Ucode filename %s\n", curr->ucode.filename);
3930a8f5989SChristophe JAILLET 		pr_debug("Ucode version string %s\n", curr->ucode.ver_str);
3940a8f5989SChristophe JAILLET 		pr_debug("Ucode version %d.%d.%d.%d\n",
395d9110b0bSSrujanaChalla 			 curr->ucode.ver_num.nn, curr->ucode.ver_num.xx,
396d9110b0bSSrujanaChalla 			 curr->ucode.ver_num.yy, curr->ucode.ver_num.zz);
3970a8f5989SChristophe JAILLET 		pr_debug("Ucode type (%d) %s\n", curr->ucode.type,
398d9110b0bSSrujanaChalla 			 get_ucode_type_str(curr->ucode.type));
3990a8f5989SChristophe JAILLET 		pr_debug("Ucode size %d\n", curr->ucode.size);
400d9110b0bSSrujanaChalla 		pr_debug("Ucode ptr %p\n", curr->ucode_ptr);
401d9110b0bSSrujanaChalla 	}
402d9110b0bSSrujanaChalla }
403d9110b0bSSrujanaChalla 
load_tar_archive(struct device * dev,char * tar_filename)404d9110b0bSSrujanaChalla static struct tar_arch_info_t *load_tar_archive(struct device *dev,
405d9110b0bSSrujanaChalla 						char *tar_filename)
406d9110b0bSSrujanaChalla {
407d9110b0bSSrujanaChalla 	struct tar_arch_info_t *tar_arch = NULL;
408d9110b0bSSrujanaChalla 	struct tar_blk_t *tar_blk;
409d9110b0bSSrujanaChalla 	unsigned int cur_size;
410d9110b0bSSrujanaChalla 	size_t tar_offs = 0;
411d9110b0bSSrujanaChalla 	size_t tar_size;
412d9110b0bSSrujanaChalla 	int ret;
413d9110b0bSSrujanaChalla 
414d9110b0bSSrujanaChalla 	tar_arch = kzalloc(sizeof(struct tar_arch_info_t), GFP_KERNEL);
415d9110b0bSSrujanaChalla 	if (!tar_arch)
416d9110b0bSSrujanaChalla 		return NULL;
417d9110b0bSSrujanaChalla 
418d9110b0bSSrujanaChalla 	INIT_LIST_HEAD(&tar_arch->ucodes);
419d9110b0bSSrujanaChalla 
420d9110b0bSSrujanaChalla 	/* Load tar archive */
421d9110b0bSSrujanaChalla 	ret = request_firmware(&tar_arch->fw, tar_filename, dev);
422d9110b0bSSrujanaChalla 	if (ret)
423d9110b0bSSrujanaChalla 		goto release_tar_arch;
424d9110b0bSSrujanaChalla 
425d9110b0bSSrujanaChalla 	if (tar_arch->fw->size < TAR_BLOCK_LEN) {
4260a8f5989SChristophe JAILLET 		dev_err(dev, "Invalid tar archive %s\n", tar_filename);
427d9110b0bSSrujanaChalla 		goto release_tar_arch;
428d9110b0bSSrujanaChalla 	}
429d9110b0bSSrujanaChalla 
430d9110b0bSSrujanaChalla 	tar_size = tar_arch->fw->size;
431d9110b0bSSrujanaChalla 	tar_blk = (struct tar_blk_t *) tar_arch->fw->data;
432d9110b0bSSrujanaChalla 	if (strncmp(tar_blk->hdr.magic, TAR_MAGIC, TAR_MAGIC_LEN - 1)) {
4330a8f5989SChristophe JAILLET 		dev_err(dev, "Unsupported format of tar archive %s\n",
434d9110b0bSSrujanaChalla 			tar_filename);
435d9110b0bSSrujanaChalla 		goto release_tar_arch;
436d9110b0bSSrujanaChalla 	}
437d9110b0bSSrujanaChalla 
438d9110b0bSSrujanaChalla 	while (1) {
439d9110b0bSSrujanaChalla 		/* Read current file size */
440d9110b0bSSrujanaChalla 		ret = kstrtouint(tar_blk->hdr.size, 8, &cur_size);
441d9110b0bSSrujanaChalla 		if (ret)
442d9110b0bSSrujanaChalla 			goto release_tar_arch;
443d9110b0bSSrujanaChalla 
444d9110b0bSSrujanaChalla 		if (tar_offs + cur_size > tar_size ||
445d9110b0bSSrujanaChalla 		    tar_offs + 2*TAR_BLOCK_LEN > tar_size) {
4460a8f5989SChristophe JAILLET 			dev_err(dev, "Invalid tar archive %s\n", tar_filename);
447d9110b0bSSrujanaChalla 			goto release_tar_arch;
448d9110b0bSSrujanaChalla 		}
449d9110b0bSSrujanaChalla 
450d9110b0bSSrujanaChalla 		tar_offs += TAR_BLOCK_LEN;
451d9110b0bSSrujanaChalla 		if (tar_blk->hdr.typeflag == REGTYPE ||
452d9110b0bSSrujanaChalla 		    tar_blk->hdr.typeflag == AREGTYPE) {
453d9110b0bSSrujanaChalla 			ret = process_tar_file(dev, tar_arch,
454d9110b0bSSrujanaChalla 					       tar_blk->hdr.name,
455d9110b0bSSrujanaChalla 					       &tar_arch->fw->data[tar_offs],
456d9110b0bSSrujanaChalla 					       cur_size);
457d9110b0bSSrujanaChalla 			if (ret)
458d9110b0bSSrujanaChalla 				goto release_tar_arch;
459d9110b0bSSrujanaChalla 		}
460d9110b0bSSrujanaChalla 
461d9110b0bSSrujanaChalla 		tar_offs += (cur_size/TAR_BLOCK_LEN) * TAR_BLOCK_LEN;
462d9110b0bSSrujanaChalla 		if (cur_size % TAR_BLOCK_LEN)
463d9110b0bSSrujanaChalla 			tar_offs += TAR_BLOCK_LEN;
464d9110b0bSSrujanaChalla 
465d9110b0bSSrujanaChalla 		/* Check for the end of the archive */
466d9110b0bSSrujanaChalla 		if (tar_offs + 2*TAR_BLOCK_LEN > tar_size) {
4670a8f5989SChristophe JAILLET 			dev_err(dev, "Invalid tar archive %s\n", tar_filename);
468d9110b0bSSrujanaChalla 			goto release_tar_arch;
469d9110b0bSSrujanaChalla 		}
470d9110b0bSSrujanaChalla 
471d9110b0bSSrujanaChalla 		if (is_mem_zero(&tar_arch->fw->data[tar_offs],
472d9110b0bSSrujanaChalla 		    2*TAR_BLOCK_LEN))
473d9110b0bSSrujanaChalla 			break;
474d9110b0bSSrujanaChalla 
475d9110b0bSSrujanaChalla 		/* Read next block from tar archive */
476d9110b0bSSrujanaChalla 		tar_blk = (struct tar_blk_t *) &tar_arch->fw->data[tar_offs];
477d9110b0bSSrujanaChalla 	}
478d9110b0bSSrujanaChalla 
479d9110b0bSSrujanaChalla 	print_tar_dbg_info(tar_arch, tar_filename);
480d9110b0bSSrujanaChalla 	return tar_arch;
481d9110b0bSSrujanaChalla release_tar_arch:
482d9110b0bSSrujanaChalla 	release_tar_archive(tar_arch);
483d9110b0bSSrujanaChalla 	return NULL;
484d9110b0bSSrujanaChalla }
485d9110b0bSSrujanaChalla 
find_engines_by_type(struct otx_cpt_eng_grp_info * eng_grp,int eng_type)486d9110b0bSSrujanaChalla static struct otx_cpt_engs_rsvd *find_engines_by_type(
487d9110b0bSSrujanaChalla 					struct otx_cpt_eng_grp_info *eng_grp,
488d9110b0bSSrujanaChalla 					int eng_type)
489d9110b0bSSrujanaChalla {
490d9110b0bSSrujanaChalla 	int i;
491d9110b0bSSrujanaChalla 
492d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
493d9110b0bSSrujanaChalla 		if (!eng_grp->engs[i].type)
494d9110b0bSSrujanaChalla 			continue;
495d9110b0bSSrujanaChalla 
496d9110b0bSSrujanaChalla 		if (eng_grp->engs[i].type == eng_type)
497d9110b0bSSrujanaChalla 			return &eng_grp->engs[i];
498d9110b0bSSrujanaChalla 	}
499d9110b0bSSrujanaChalla 	return NULL;
500d9110b0bSSrujanaChalla }
501d9110b0bSSrujanaChalla 
otx_cpt_uc_supports_eng_type(struct otx_cpt_ucode * ucode,int eng_type)502d9110b0bSSrujanaChalla int otx_cpt_uc_supports_eng_type(struct otx_cpt_ucode *ucode, int eng_type)
503d9110b0bSSrujanaChalla {
504d9110b0bSSrujanaChalla 	return is_eng_type(ucode->type, eng_type);
505d9110b0bSSrujanaChalla }
506d9110b0bSSrujanaChalla EXPORT_SYMBOL_GPL(otx_cpt_uc_supports_eng_type);
507d9110b0bSSrujanaChalla 
otx_cpt_eng_grp_has_eng_type(struct otx_cpt_eng_grp_info * eng_grp,int eng_type)508d9110b0bSSrujanaChalla int otx_cpt_eng_grp_has_eng_type(struct otx_cpt_eng_grp_info *eng_grp,
509d9110b0bSSrujanaChalla 				 int eng_type)
510d9110b0bSSrujanaChalla {
511d9110b0bSSrujanaChalla 	struct otx_cpt_engs_rsvd *engs;
512d9110b0bSSrujanaChalla 
513d9110b0bSSrujanaChalla 	engs = find_engines_by_type(eng_grp, eng_type);
514d9110b0bSSrujanaChalla 
515d9110b0bSSrujanaChalla 	return (engs != NULL ? 1 : 0);
516d9110b0bSSrujanaChalla }
517d9110b0bSSrujanaChalla EXPORT_SYMBOL_GPL(otx_cpt_eng_grp_has_eng_type);
518d9110b0bSSrujanaChalla 
print_ucode_info(struct otx_cpt_eng_grp_info * eng_grp,char * buf,int size)519d9110b0bSSrujanaChalla static void print_ucode_info(struct otx_cpt_eng_grp_info *eng_grp,
520d9110b0bSSrujanaChalla 			     char *buf, int size)
521d9110b0bSSrujanaChalla {
522d9110b0bSSrujanaChalla 	if (eng_grp->mirror.is_ena) {
523d9110b0bSSrujanaChalla 		scnprintf(buf, size, "%s (shared with engine_group%d)",
524d9110b0bSSrujanaChalla 			  eng_grp->g->grp[eng_grp->mirror.idx].ucode[0].ver_str,
525d9110b0bSSrujanaChalla 			  eng_grp->mirror.idx);
526d9110b0bSSrujanaChalla 	} else {
527d9110b0bSSrujanaChalla 		scnprintf(buf, size, "%s", eng_grp->ucode[0].ver_str);
528d9110b0bSSrujanaChalla 	}
529d9110b0bSSrujanaChalla }
530d9110b0bSSrujanaChalla 
print_engs_info(struct otx_cpt_eng_grp_info * eng_grp,char * buf,int size,int idx)531d9110b0bSSrujanaChalla static void print_engs_info(struct otx_cpt_eng_grp_info *eng_grp,
532d9110b0bSSrujanaChalla 			    char *buf, int size, int idx)
533d9110b0bSSrujanaChalla {
534d9110b0bSSrujanaChalla 	struct otx_cpt_engs_rsvd *mirrored_engs = NULL;
535d9110b0bSSrujanaChalla 	struct otx_cpt_engs_rsvd *engs;
536d9110b0bSSrujanaChalla 	int len, i;
537d9110b0bSSrujanaChalla 
538d9110b0bSSrujanaChalla 	buf[0] = '\0';
539d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
540d9110b0bSSrujanaChalla 		engs = &eng_grp->engs[i];
541d9110b0bSSrujanaChalla 		if (!engs->type)
542d9110b0bSSrujanaChalla 			continue;
543d9110b0bSSrujanaChalla 		if (idx != -1 && idx != i)
544d9110b0bSSrujanaChalla 			continue;
545d9110b0bSSrujanaChalla 
546d9110b0bSSrujanaChalla 		if (eng_grp->mirror.is_ena)
547d9110b0bSSrujanaChalla 			mirrored_engs = find_engines_by_type(
548d9110b0bSSrujanaChalla 					&eng_grp->g->grp[eng_grp->mirror.idx],
549d9110b0bSSrujanaChalla 					engs->type);
550d9110b0bSSrujanaChalla 		if (i > 0 && idx == -1) {
551d9110b0bSSrujanaChalla 			len = strlen(buf);
552d9110b0bSSrujanaChalla 			scnprintf(buf+len, size-len, ", ");
553d9110b0bSSrujanaChalla 		}
554d9110b0bSSrujanaChalla 
555d9110b0bSSrujanaChalla 		len = strlen(buf);
556d9110b0bSSrujanaChalla 		scnprintf(buf+len, size-len, "%d %s ", mirrored_engs ?
557d9110b0bSSrujanaChalla 			  engs->count + mirrored_engs->count : engs->count,
558d9110b0bSSrujanaChalla 			  get_eng_type_str(engs->type));
559d9110b0bSSrujanaChalla 		if (mirrored_engs) {
560d9110b0bSSrujanaChalla 			len = strlen(buf);
561d9110b0bSSrujanaChalla 			scnprintf(buf+len, size-len,
562d9110b0bSSrujanaChalla 				  "(%d shared with engine_group%d) ",
563d9110b0bSSrujanaChalla 				  engs->count <= 0 ? engs->count +
564d9110b0bSSrujanaChalla 				  mirrored_engs->count : mirrored_engs->count,
565d9110b0bSSrujanaChalla 				  eng_grp->mirror.idx);
566d9110b0bSSrujanaChalla 		}
567d9110b0bSSrujanaChalla 	}
568d9110b0bSSrujanaChalla }
569d9110b0bSSrujanaChalla 
print_ucode_dbg_info(struct otx_cpt_ucode * ucode)570d9110b0bSSrujanaChalla static void print_ucode_dbg_info(struct otx_cpt_ucode *ucode)
571d9110b0bSSrujanaChalla {
5720a8f5989SChristophe JAILLET 	pr_debug("Ucode info\n");
5730a8f5989SChristophe JAILLET 	pr_debug("Ucode version string %s\n", ucode->ver_str);
5740a8f5989SChristophe JAILLET 	pr_debug("Ucode version %d.%d.%d.%d\n", ucode->ver_num.nn,
575d9110b0bSSrujanaChalla 		 ucode->ver_num.xx, ucode->ver_num.yy, ucode->ver_num.zz);
5760a8f5989SChristophe JAILLET 	pr_debug("Ucode type %s\n", get_ucode_type_str(ucode->type));
5770a8f5989SChristophe JAILLET 	pr_debug("Ucode size %d\n", ucode->size);
5780a8f5989SChristophe JAILLET 	pr_debug("Ucode virt address %16.16llx\n", (u64)ucode->align_va);
579d9110b0bSSrujanaChalla 	pr_debug("Ucode phys address %16.16llx\n", ucode->align_dma);
580d9110b0bSSrujanaChalla }
581d9110b0bSSrujanaChalla 
cpt_print_engines_mask(struct otx_cpt_eng_grp_info * eng_grp,struct device * dev,char * buf,int size)582d9110b0bSSrujanaChalla static void cpt_print_engines_mask(struct otx_cpt_eng_grp_info *eng_grp,
583d9110b0bSSrujanaChalla 				   struct device *dev, char *buf, int size)
584d9110b0bSSrujanaChalla {
585d9110b0bSSrujanaChalla 	struct otx_cpt_bitmap bmap;
586d9110b0bSSrujanaChalla 	u32 mask[2];
587d9110b0bSSrujanaChalla 
588d9110b0bSSrujanaChalla 	bmap = get_cores_bmap(dev, eng_grp);
589d9110b0bSSrujanaChalla 	if (!bmap.size) {
590d9110b0bSSrujanaChalla 		scnprintf(buf, size, "unknown");
591d9110b0bSSrujanaChalla 		return;
592d9110b0bSSrujanaChalla 	}
593d9110b0bSSrujanaChalla 	bitmap_to_arr32(mask, bmap.bits, bmap.size);
594d9110b0bSSrujanaChalla 	scnprintf(buf, size, "%8.8x %8.8x", mask[1], mask[0]);
595d9110b0bSSrujanaChalla }
596d9110b0bSSrujanaChalla 
597d9110b0bSSrujanaChalla 
print_dbg_info(struct device * dev,struct otx_cpt_eng_grps * eng_grps)598d9110b0bSSrujanaChalla static void print_dbg_info(struct device *dev,
599d9110b0bSSrujanaChalla 			   struct otx_cpt_eng_grps *eng_grps)
600d9110b0bSSrujanaChalla {
601d9110b0bSSrujanaChalla 	char engs_info[2*OTX_CPT_UCODE_NAME_LENGTH];
602d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *mirrored_grp;
603d9110b0bSSrujanaChalla 	char engs_mask[OTX_CPT_UCODE_NAME_LENGTH];
604d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *grp;
605d9110b0bSSrujanaChalla 	struct otx_cpt_engs_rsvd *engs;
606d9110b0bSSrujanaChalla 	u32 mask[4];
607d9110b0bSSrujanaChalla 	int i, j;
608d9110b0bSSrujanaChalla 
6090a8f5989SChristophe JAILLET 	pr_debug("Engine groups global info\n");
6100a8f5989SChristophe JAILLET 	pr_debug("max SE %d, max AE %d\n",
611d9110b0bSSrujanaChalla 		 eng_grps->avail.max_se_cnt, eng_grps->avail.max_ae_cnt);
6120a8f5989SChristophe JAILLET 	pr_debug("free SE %d\n", eng_grps->avail.se_cnt);
6130a8f5989SChristophe JAILLET 	pr_debug("free AE %d\n", eng_grps->avail.ae_cnt);
614d9110b0bSSrujanaChalla 
615d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++) {
616d9110b0bSSrujanaChalla 		grp = &eng_grps->grp[i];
6170a8f5989SChristophe JAILLET 		pr_debug("engine_group%d, state %s\n", i, grp->is_enabled ?
618d9110b0bSSrujanaChalla 			 "enabled" : "disabled");
619d9110b0bSSrujanaChalla 		if (grp->is_enabled) {
620d9110b0bSSrujanaChalla 			mirrored_grp = &eng_grps->grp[grp->mirror.idx];
6210a8f5989SChristophe JAILLET 			pr_debug("Ucode0 filename %s, version %s\n",
622d9110b0bSSrujanaChalla 				 grp->mirror.is_ena ?
623d9110b0bSSrujanaChalla 				 mirrored_grp->ucode[0].filename :
624d9110b0bSSrujanaChalla 				 grp->ucode[0].filename,
625d9110b0bSSrujanaChalla 				 grp->mirror.is_ena ?
626d9110b0bSSrujanaChalla 				 mirrored_grp->ucode[0].ver_str :
627d9110b0bSSrujanaChalla 				 grp->ucode[0].ver_str);
628d9110b0bSSrujanaChalla 		}
629d9110b0bSSrujanaChalla 
630d9110b0bSSrujanaChalla 		for (j = 0; j < OTX_CPT_MAX_ETYPES_PER_GRP; j++) {
631d9110b0bSSrujanaChalla 			engs = &grp->engs[j];
632d9110b0bSSrujanaChalla 			if (engs->type) {
633d9110b0bSSrujanaChalla 				print_engs_info(grp, engs_info,
634d9110b0bSSrujanaChalla 						2*OTX_CPT_UCODE_NAME_LENGTH, j);
6350a8f5989SChristophe JAILLET 				pr_debug("Slot%d: %s\n", j, engs_info);
636d9110b0bSSrujanaChalla 				bitmap_to_arr32(mask, engs->bmap,
637d9110b0bSSrujanaChalla 						eng_grps->engs_num);
6380a8f5989SChristophe JAILLET 				pr_debug("Mask: %8.8x %8.8x %8.8x %8.8x\n",
639d9110b0bSSrujanaChalla 					 mask[3], mask[2], mask[1], mask[0]);
640d9110b0bSSrujanaChalla 			} else
6410a8f5989SChristophe JAILLET 				pr_debug("Slot%d not used\n", j);
642d9110b0bSSrujanaChalla 		}
643d9110b0bSSrujanaChalla 		if (grp->is_enabled) {
644d9110b0bSSrujanaChalla 			cpt_print_engines_mask(grp, dev, engs_mask,
645d9110b0bSSrujanaChalla 					       OTX_CPT_UCODE_NAME_LENGTH);
6460a8f5989SChristophe JAILLET 			pr_debug("Cmask: %s\n", engs_mask);
647d9110b0bSSrujanaChalla 		}
648d9110b0bSSrujanaChalla 	}
649d9110b0bSSrujanaChalla }
650d9110b0bSSrujanaChalla 
update_engines_avail_count(struct device * dev,struct otx_cpt_engs_available * avail,struct otx_cpt_engs_rsvd * engs,int val)651d9110b0bSSrujanaChalla static int update_engines_avail_count(struct device *dev,
652d9110b0bSSrujanaChalla 				      struct otx_cpt_engs_available *avail,
653d9110b0bSSrujanaChalla 				      struct otx_cpt_engs_rsvd *engs, int val)
654d9110b0bSSrujanaChalla {
655d9110b0bSSrujanaChalla 	switch (engs->type) {
656d9110b0bSSrujanaChalla 	case OTX_CPT_SE_TYPES:
657d9110b0bSSrujanaChalla 		avail->se_cnt += val;
658d9110b0bSSrujanaChalla 		break;
659d9110b0bSSrujanaChalla 
660d9110b0bSSrujanaChalla 	case OTX_CPT_AE_TYPES:
661d9110b0bSSrujanaChalla 		avail->ae_cnt += val;
662d9110b0bSSrujanaChalla 		break;
663d9110b0bSSrujanaChalla 
664d9110b0bSSrujanaChalla 	default:
665d9110b0bSSrujanaChalla 		dev_err(dev, "Invalid engine type %d\n", engs->type);
666d9110b0bSSrujanaChalla 		return -EINVAL;
667d9110b0bSSrujanaChalla 	}
668d9110b0bSSrujanaChalla 
669d9110b0bSSrujanaChalla 	return 0;
670d9110b0bSSrujanaChalla }
671d9110b0bSSrujanaChalla 
update_engines_offset(struct device * dev,struct otx_cpt_engs_available * avail,struct otx_cpt_engs_rsvd * engs)672d9110b0bSSrujanaChalla static int update_engines_offset(struct device *dev,
673d9110b0bSSrujanaChalla 				 struct otx_cpt_engs_available *avail,
674d9110b0bSSrujanaChalla 				 struct otx_cpt_engs_rsvd *engs)
675d9110b0bSSrujanaChalla {
676d9110b0bSSrujanaChalla 	switch (engs->type) {
677d9110b0bSSrujanaChalla 	case OTX_CPT_SE_TYPES:
678d9110b0bSSrujanaChalla 		engs->offset = 0;
679d9110b0bSSrujanaChalla 		break;
680d9110b0bSSrujanaChalla 
681d9110b0bSSrujanaChalla 	case OTX_CPT_AE_TYPES:
682d9110b0bSSrujanaChalla 		engs->offset = avail->max_se_cnt;
683d9110b0bSSrujanaChalla 		break;
684d9110b0bSSrujanaChalla 
685d9110b0bSSrujanaChalla 	default:
686d9110b0bSSrujanaChalla 		dev_err(dev, "Invalid engine type %d\n", engs->type);
687d9110b0bSSrujanaChalla 		return -EINVAL;
688d9110b0bSSrujanaChalla 	}
689d9110b0bSSrujanaChalla 
690d9110b0bSSrujanaChalla 	return 0;
691d9110b0bSSrujanaChalla }
692d9110b0bSSrujanaChalla 
release_engines(struct device * dev,struct otx_cpt_eng_grp_info * grp)693d9110b0bSSrujanaChalla static int release_engines(struct device *dev, struct otx_cpt_eng_grp_info *grp)
694d9110b0bSSrujanaChalla {
695d9110b0bSSrujanaChalla 	int i, ret = 0;
696d9110b0bSSrujanaChalla 
697d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
698d9110b0bSSrujanaChalla 		if (!grp->engs[i].type)
699d9110b0bSSrujanaChalla 			continue;
700d9110b0bSSrujanaChalla 
701d9110b0bSSrujanaChalla 		if (grp->engs[i].count > 0) {
702d9110b0bSSrujanaChalla 			ret = update_engines_avail_count(dev, &grp->g->avail,
703d9110b0bSSrujanaChalla 							 &grp->engs[i],
704d9110b0bSSrujanaChalla 							 grp->engs[i].count);
705d9110b0bSSrujanaChalla 			if (ret)
706d9110b0bSSrujanaChalla 				return ret;
707d9110b0bSSrujanaChalla 		}
708d9110b0bSSrujanaChalla 
709d9110b0bSSrujanaChalla 		grp->engs[i].type = 0;
710d9110b0bSSrujanaChalla 		grp->engs[i].count = 0;
711d9110b0bSSrujanaChalla 		grp->engs[i].offset = 0;
712d9110b0bSSrujanaChalla 		grp->engs[i].ucode = NULL;
713d9110b0bSSrujanaChalla 		bitmap_zero(grp->engs[i].bmap, grp->g->engs_num);
714d9110b0bSSrujanaChalla 	}
715d9110b0bSSrujanaChalla 
716d9110b0bSSrujanaChalla 	return 0;
717d9110b0bSSrujanaChalla }
718d9110b0bSSrujanaChalla 
do_reserve_engines(struct device * dev,struct otx_cpt_eng_grp_info * grp,struct otx_cpt_engines * req_engs)719d9110b0bSSrujanaChalla static int do_reserve_engines(struct device *dev,
720d9110b0bSSrujanaChalla 			      struct otx_cpt_eng_grp_info *grp,
721d9110b0bSSrujanaChalla 			      struct otx_cpt_engines *req_engs)
722d9110b0bSSrujanaChalla {
723d9110b0bSSrujanaChalla 	struct otx_cpt_engs_rsvd *engs = NULL;
724d9110b0bSSrujanaChalla 	int i, ret;
725d9110b0bSSrujanaChalla 
726d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
727d9110b0bSSrujanaChalla 		if (!grp->engs[i].type) {
728d9110b0bSSrujanaChalla 			engs = &grp->engs[i];
729d9110b0bSSrujanaChalla 			break;
730d9110b0bSSrujanaChalla 		}
731d9110b0bSSrujanaChalla 	}
732d9110b0bSSrujanaChalla 
733d9110b0bSSrujanaChalla 	if (!engs)
734d9110b0bSSrujanaChalla 		return -ENOMEM;
735d9110b0bSSrujanaChalla 
736d9110b0bSSrujanaChalla 	engs->type = req_engs->type;
737d9110b0bSSrujanaChalla 	engs->count = req_engs->count;
738d9110b0bSSrujanaChalla 
739d9110b0bSSrujanaChalla 	ret = update_engines_offset(dev, &grp->g->avail, engs);
740d9110b0bSSrujanaChalla 	if (ret)
741d9110b0bSSrujanaChalla 		return ret;
742d9110b0bSSrujanaChalla 
743d9110b0bSSrujanaChalla 	if (engs->count > 0) {
744d9110b0bSSrujanaChalla 		ret = update_engines_avail_count(dev, &grp->g->avail, engs,
745d9110b0bSSrujanaChalla 						 -engs->count);
746d9110b0bSSrujanaChalla 		if (ret)
747d9110b0bSSrujanaChalla 			return ret;
748d9110b0bSSrujanaChalla 	}
749d9110b0bSSrujanaChalla 
750d9110b0bSSrujanaChalla 	return 0;
751d9110b0bSSrujanaChalla }
752d9110b0bSSrujanaChalla 
check_engines_availability(struct device * dev,struct otx_cpt_eng_grp_info * grp,struct otx_cpt_engines * req_eng)753d9110b0bSSrujanaChalla static int check_engines_availability(struct device *dev,
754d9110b0bSSrujanaChalla 				      struct otx_cpt_eng_grp_info *grp,
755d9110b0bSSrujanaChalla 				      struct otx_cpt_engines *req_eng)
756d9110b0bSSrujanaChalla {
757d9110b0bSSrujanaChalla 	int avail_cnt = 0;
758d9110b0bSSrujanaChalla 
759d9110b0bSSrujanaChalla 	switch (req_eng->type) {
760d9110b0bSSrujanaChalla 	case OTX_CPT_SE_TYPES:
761d9110b0bSSrujanaChalla 		avail_cnt = grp->g->avail.se_cnt;
762d9110b0bSSrujanaChalla 		break;
763d9110b0bSSrujanaChalla 
764d9110b0bSSrujanaChalla 	case OTX_CPT_AE_TYPES:
765d9110b0bSSrujanaChalla 		avail_cnt = grp->g->avail.ae_cnt;
766d9110b0bSSrujanaChalla 		break;
767d9110b0bSSrujanaChalla 
768d9110b0bSSrujanaChalla 	default:
769d9110b0bSSrujanaChalla 		dev_err(dev, "Invalid engine type %d\n", req_eng->type);
770d9110b0bSSrujanaChalla 		return -EINVAL;
771d9110b0bSSrujanaChalla 	}
772d9110b0bSSrujanaChalla 
773d9110b0bSSrujanaChalla 	if (avail_cnt < req_eng->count) {
774d9110b0bSSrujanaChalla 		dev_err(dev,
7750a8f5989SChristophe JAILLET 			"Error available %s engines %d < than requested %d\n",
776d9110b0bSSrujanaChalla 			get_eng_type_str(req_eng->type),
777d9110b0bSSrujanaChalla 			avail_cnt, req_eng->count);
778d9110b0bSSrujanaChalla 		return -EBUSY;
779d9110b0bSSrujanaChalla 	}
780d9110b0bSSrujanaChalla 
781d9110b0bSSrujanaChalla 	return 0;
782d9110b0bSSrujanaChalla }
783d9110b0bSSrujanaChalla 
reserve_engines(struct device * dev,struct otx_cpt_eng_grp_info * grp,struct otx_cpt_engines * req_engs,int req_cnt)784d9110b0bSSrujanaChalla static int reserve_engines(struct device *dev, struct otx_cpt_eng_grp_info *grp,
785d9110b0bSSrujanaChalla 			   struct otx_cpt_engines *req_engs, int req_cnt)
786d9110b0bSSrujanaChalla {
787d9110b0bSSrujanaChalla 	int i, ret;
788d9110b0bSSrujanaChalla 
789d9110b0bSSrujanaChalla 	/* Validate if a number of requested engines is available */
790d9110b0bSSrujanaChalla 	for (i = 0; i < req_cnt; i++) {
791d9110b0bSSrujanaChalla 		ret = check_engines_availability(dev, grp, &req_engs[i]);
792d9110b0bSSrujanaChalla 		if (ret)
793d9110b0bSSrujanaChalla 			return ret;
794d9110b0bSSrujanaChalla 	}
795d9110b0bSSrujanaChalla 
796d9110b0bSSrujanaChalla 	/* Reserve requested engines for this engine group */
797d9110b0bSSrujanaChalla 	for (i = 0; i < req_cnt; i++) {
798d9110b0bSSrujanaChalla 		ret = do_reserve_engines(dev, grp, &req_engs[i]);
799d9110b0bSSrujanaChalla 		if (ret)
800d9110b0bSSrujanaChalla 			return ret;
801d9110b0bSSrujanaChalla 	}
802d9110b0bSSrujanaChalla 	return 0;
803d9110b0bSSrujanaChalla }
804d9110b0bSSrujanaChalla 
eng_grp_info_show(struct device * dev,struct device_attribute * attr,char * buf)805d9110b0bSSrujanaChalla static ssize_t eng_grp_info_show(struct device *dev,
806d9110b0bSSrujanaChalla 				 struct device_attribute *attr,
807d9110b0bSSrujanaChalla 				 char *buf)
808d9110b0bSSrujanaChalla {
809d9110b0bSSrujanaChalla 	char ucode_info[2*OTX_CPT_UCODE_NAME_LENGTH];
810d9110b0bSSrujanaChalla 	char engs_info[2*OTX_CPT_UCODE_NAME_LENGTH];
811d9110b0bSSrujanaChalla 	char engs_mask[OTX_CPT_UCODE_NAME_LENGTH];
812d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *eng_grp;
813d9110b0bSSrujanaChalla 	int ret;
814d9110b0bSSrujanaChalla 
815d9110b0bSSrujanaChalla 	eng_grp = container_of(attr, struct otx_cpt_eng_grp_info, info_attr);
816d9110b0bSSrujanaChalla 	mutex_lock(&eng_grp->g->lock);
817d9110b0bSSrujanaChalla 
818d9110b0bSSrujanaChalla 	print_engs_info(eng_grp, engs_info, 2*OTX_CPT_UCODE_NAME_LENGTH, -1);
819d9110b0bSSrujanaChalla 	print_ucode_info(eng_grp, ucode_info, 2*OTX_CPT_UCODE_NAME_LENGTH);
820d9110b0bSSrujanaChalla 	cpt_print_engines_mask(eng_grp, dev, engs_mask,
821d9110b0bSSrujanaChalla 			       OTX_CPT_UCODE_NAME_LENGTH);
822d9110b0bSSrujanaChalla 	ret = scnprintf(buf, PAGE_SIZE,
823d9110b0bSSrujanaChalla 			"Microcode : %s\nEngines: %s\nEngines mask: %s\n",
824d9110b0bSSrujanaChalla 			ucode_info, engs_info, engs_mask);
825d9110b0bSSrujanaChalla 
826d9110b0bSSrujanaChalla 	mutex_unlock(&eng_grp->g->lock);
827d9110b0bSSrujanaChalla 	return ret;
828d9110b0bSSrujanaChalla }
829d9110b0bSSrujanaChalla 
create_sysfs_eng_grps_info(struct device * dev,struct otx_cpt_eng_grp_info * eng_grp)830d9110b0bSSrujanaChalla static int create_sysfs_eng_grps_info(struct device *dev,
831d9110b0bSSrujanaChalla 				      struct otx_cpt_eng_grp_info *eng_grp)
832d9110b0bSSrujanaChalla {
833d9110b0bSSrujanaChalla 	eng_grp->info_attr.show = eng_grp_info_show;
834d9110b0bSSrujanaChalla 	eng_grp->info_attr.store = NULL;
835d9110b0bSSrujanaChalla 	eng_grp->info_attr.attr.name = eng_grp->sysfs_info_name;
836d9110b0bSSrujanaChalla 	eng_grp->info_attr.attr.mode = 0440;
837d9110b0bSSrujanaChalla 	sysfs_attr_init(&eng_grp->info_attr.attr);
8385784cfb2SQinglang Miao 	return device_create_file(dev, &eng_grp->info_attr);
839d9110b0bSSrujanaChalla }
840d9110b0bSSrujanaChalla 
ucode_unload(struct device * dev,struct otx_cpt_ucode * ucode)841d9110b0bSSrujanaChalla static void ucode_unload(struct device *dev, struct otx_cpt_ucode *ucode)
842d9110b0bSSrujanaChalla {
843d9110b0bSSrujanaChalla 	if (ucode->va) {
844d9110b0bSSrujanaChalla 		dma_free_coherent(dev, ucode->size + OTX_CPT_UCODE_ALIGNMENT,
845d9110b0bSSrujanaChalla 				  ucode->va, ucode->dma);
846d9110b0bSSrujanaChalla 		ucode->va = NULL;
847d9110b0bSSrujanaChalla 		ucode->align_va = NULL;
848d9110b0bSSrujanaChalla 		ucode->dma = 0;
849d9110b0bSSrujanaChalla 		ucode->align_dma = 0;
850d9110b0bSSrujanaChalla 		ucode->size = 0;
851d9110b0bSSrujanaChalla 	}
852d9110b0bSSrujanaChalla 
853d9110b0bSSrujanaChalla 	memset(&ucode->ver_str, 0, OTX_CPT_UCODE_VER_STR_SZ);
854d9110b0bSSrujanaChalla 	memset(&ucode->ver_num, 0, sizeof(struct otx_cpt_ucode_ver_num));
855d9110b0bSSrujanaChalla 	set_ucode_filename(ucode, "");
856d9110b0bSSrujanaChalla 	ucode->type = 0;
857d9110b0bSSrujanaChalla }
858d9110b0bSSrujanaChalla 
copy_ucode_to_dma_mem(struct device * dev,struct otx_cpt_ucode * ucode,const u8 * ucode_data)859d9110b0bSSrujanaChalla static int copy_ucode_to_dma_mem(struct device *dev,
860d9110b0bSSrujanaChalla 				 struct otx_cpt_ucode *ucode,
861d9110b0bSSrujanaChalla 				 const u8 *ucode_data)
862d9110b0bSSrujanaChalla {
863d9110b0bSSrujanaChalla 	u32 i;
864d9110b0bSSrujanaChalla 
865d9110b0bSSrujanaChalla 	/*  Allocate DMAable space */
866d9110b0bSSrujanaChalla 	ucode->va = dma_alloc_coherent(dev, ucode->size +
867d9110b0bSSrujanaChalla 				       OTX_CPT_UCODE_ALIGNMENT,
868d9110b0bSSrujanaChalla 				       &ucode->dma, GFP_KERNEL);
869d9110b0bSSrujanaChalla 	if (!ucode->va) {
8700a8f5989SChristophe JAILLET 		dev_err(dev, "Unable to allocate space for microcode\n");
871d9110b0bSSrujanaChalla 		return -ENOMEM;
872d9110b0bSSrujanaChalla 	}
873d9110b0bSSrujanaChalla 	ucode->align_va = PTR_ALIGN(ucode->va, OTX_CPT_UCODE_ALIGNMENT);
874d9110b0bSSrujanaChalla 	ucode->align_dma = PTR_ALIGN(ucode->dma, OTX_CPT_UCODE_ALIGNMENT);
875d9110b0bSSrujanaChalla 
876d9110b0bSSrujanaChalla 	memcpy((void *) ucode->align_va, (void *) ucode_data +
877d9110b0bSSrujanaChalla 	       sizeof(struct otx_cpt_ucode_hdr), ucode->size);
878d9110b0bSSrujanaChalla 
879d9110b0bSSrujanaChalla 	/* Byte swap 64-bit */
880d9110b0bSSrujanaChalla 	for (i = 0; i < (ucode->size / 8); i++)
881a05b1c15SHerbert Xu 		((__be64 *)ucode->align_va)[i] =
882d9110b0bSSrujanaChalla 				cpu_to_be64(((u64 *)ucode->align_va)[i]);
883d9110b0bSSrujanaChalla 	/*  Ucode needs 16-bit swap */
884d9110b0bSSrujanaChalla 	for (i = 0; i < (ucode->size / 2); i++)
885a05b1c15SHerbert Xu 		((__be16 *)ucode->align_va)[i] =
886d9110b0bSSrujanaChalla 				cpu_to_be16(((u16 *)ucode->align_va)[i]);
887d9110b0bSSrujanaChalla 	return 0;
888d9110b0bSSrujanaChalla }
889d9110b0bSSrujanaChalla 
ucode_load(struct device * dev,struct otx_cpt_ucode * ucode,const char * ucode_filename)890d9110b0bSSrujanaChalla static int ucode_load(struct device *dev, struct otx_cpt_ucode *ucode,
891d9110b0bSSrujanaChalla 		      const char *ucode_filename)
892d9110b0bSSrujanaChalla {
893d9110b0bSSrujanaChalla 	struct otx_cpt_ucode_hdr *ucode_hdr;
894d9110b0bSSrujanaChalla 	const struct firmware *fw;
895*caca37cfSDan Carpenter 	unsigned int code_length;
896d9110b0bSSrujanaChalla 	int ret;
897d9110b0bSSrujanaChalla 
898d9110b0bSSrujanaChalla 	set_ucode_filename(ucode, ucode_filename);
899d9110b0bSSrujanaChalla 	ret = request_firmware(&fw, ucode->filename, dev);
900d9110b0bSSrujanaChalla 	if (ret)
901d9110b0bSSrujanaChalla 		return ret;
902d9110b0bSSrujanaChalla 
903d9110b0bSSrujanaChalla 	ucode_hdr = (struct otx_cpt_ucode_hdr *) fw->data;
904d9110b0bSSrujanaChalla 	memcpy(ucode->ver_str, ucode_hdr->ver_str, OTX_CPT_UCODE_VER_STR_SZ);
905d9110b0bSSrujanaChalla 	ucode->ver_num = ucode_hdr->ver_num;
906*caca37cfSDan Carpenter 	code_length = ntohl(ucode_hdr->code_length);
907*caca37cfSDan Carpenter 	if (code_length >= INT_MAX / 2) {
908*caca37cfSDan Carpenter 		dev_err(dev, "Ucode invalid code_length %u\n", code_length);
909*caca37cfSDan Carpenter 		ret = -EINVAL;
910*caca37cfSDan Carpenter 		goto release_fw;
911*caca37cfSDan Carpenter 	}
912*caca37cfSDan Carpenter 	ucode->size = code_length * 2;
913d9110b0bSSrujanaChalla 	if (!ucode->size || (fw->size < round_up(ucode->size, 16)
914d9110b0bSSrujanaChalla 	    + sizeof(struct otx_cpt_ucode_hdr) + OTX_CPT_UCODE_SIGN_LEN)) {
9150a8f5989SChristophe JAILLET 		dev_err(dev, "Ucode %s invalid size\n", ucode_filename);
916d9110b0bSSrujanaChalla 		ret = -EINVAL;
917d9110b0bSSrujanaChalla 		goto release_fw;
918d9110b0bSSrujanaChalla 	}
919d9110b0bSSrujanaChalla 
920d9110b0bSSrujanaChalla 	ret = get_ucode_type(ucode_hdr, &ucode->type);
921d9110b0bSSrujanaChalla 	if (ret) {
9220a8f5989SChristophe JAILLET 		dev_err(dev, "Microcode %s unknown type 0x%x\n",
9230a8f5989SChristophe JAILLET 			ucode->filename, ucode->type);
924d9110b0bSSrujanaChalla 		goto release_fw;
925d9110b0bSSrujanaChalla 	}
926d9110b0bSSrujanaChalla 
927d9110b0bSSrujanaChalla 	ret = copy_ucode_to_dma_mem(dev, ucode, fw->data);
928d9110b0bSSrujanaChalla 	if (ret)
929d9110b0bSSrujanaChalla 		goto release_fw;
930d9110b0bSSrujanaChalla 
931d9110b0bSSrujanaChalla 	print_ucode_dbg_info(ucode);
932d9110b0bSSrujanaChalla release_fw:
933d9110b0bSSrujanaChalla 	release_firmware(fw);
934d9110b0bSSrujanaChalla 	return ret;
935d9110b0bSSrujanaChalla }
936d9110b0bSSrujanaChalla 
enable_eng_grp(struct otx_cpt_eng_grp_info * eng_grp,void * obj)937d9110b0bSSrujanaChalla static int enable_eng_grp(struct otx_cpt_eng_grp_info *eng_grp,
938d9110b0bSSrujanaChalla 			  void *obj)
939d9110b0bSSrujanaChalla {
940d9110b0bSSrujanaChalla 	int ret;
941d9110b0bSSrujanaChalla 
942d9110b0bSSrujanaChalla 	ret = cpt_set_ucode_base(eng_grp, obj);
943d9110b0bSSrujanaChalla 	if (ret)
944d9110b0bSSrujanaChalla 		return ret;
945d9110b0bSSrujanaChalla 
946d9110b0bSSrujanaChalla 	ret = cpt_attach_and_enable_cores(eng_grp, obj);
947d9110b0bSSrujanaChalla 	return ret;
948d9110b0bSSrujanaChalla }
949d9110b0bSSrujanaChalla 
disable_eng_grp(struct device * dev,struct otx_cpt_eng_grp_info * eng_grp,void * obj)950d9110b0bSSrujanaChalla static int disable_eng_grp(struct device *dev,
951d9110b0bSSrujanaChalla 			   struct otx_cpt_eng_grp_info *eng_grp,
952d9110b0bSSrujanaChalla 			   void *obj)
953d9110b0bSSrujanaChalla {
954d9110b0bSSrujanaChalla 	int i, ret;
955d9110b0bSSrujanaChalla 
956d9110b0bSSrujanaChalla 	ret = cpt_detach_and_disable_cores(eng_grp, obj);
957d9110b0bSSrujanaChalla 	if (ret)
958d9110b0bSSrujanaChalla 		return ret;
959d9110b0bSSrujanaChalla 
960d9110b0bSSrujanaChalla 	/* Unload ucode used by this engine group */
961d9110b0bSSrujanaChalla 	ucode_unload(dev, &eng_grp->ucode[0]);
962d9110b0bSSrujanaChalla 
963d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
964d9110b0bSSrujanaChalla 		if (!eng_grp->engs[i].type)
965d9110b0bSSrujanaChalla 			continue;
966d9110b0bSSrujanaChalla 
967d9110b0bSSrujanaChalla 		eng_grp->engs[i].ucode = &eng_grp->ucode[0];
968d9110b0bSSrujanaChalla 	}
969d9110b0bSSrujanaChalla 
970d9110b0bSSrujanaChalla 	ret = cpt_set_ucode_base(eng_grp, obj);
971d9110b0bSSrujanaChalla 
972d9110b0bSSrujanaChalla 	return ret;
973d9110b0bSSrujanaChalla }
974d9110b0bSSrujanaChalla 
setup_eng_grp_mirroring(struct otx_cpt_eng_grp_info * dst_grp,struct otx_cpt_eng_grp_info * src_grp)975d9110b0bSSrujanaChalla static void setup_eng_grp_mirroring(struct otx_cpt_eng_grp_info *dst_grp,
976d9110b0bSSrujanaChalla 				    struct otx_cpt_eng_grp_info *src_grp)
977d9110b0bSSrujanaChalla {
978d9110b0bSSrujanaChalla 	/* Setup fields for engine group which is mirrored */
979d9110b0bSSrujanaChalla 	src_grp->mirror.is_ena = false;
980d9110b0bSSrujanaChalla 	src_grp->mirror.idx = 0;
981d9110b0bSSrujanaChalla 	src_grp->mirror.ref_count++;
982d9110b0bSSrujanaChalla 
983d9110b0bSSrujanaChalla 	/* Setup fields for mirroring engine group */
984d9110b0bSSrujanaChalla 	dst_grp->mirror.is_ena = true;
985d9110b0bSSrujanaChalla 	dst_grp->mirror.idx = src_grp->idx;
986d9110b0bSSrujanaChalla 	dst_grp->mirror.ref_count = 0;
987d9110b0bSSrujanaChalla }
988d9110b0bSSrujanaChalla 
remove_eng_grp_mirroring(struct otx_cpt_eng_grp_info * dst_grp)989d9110b0bSSrujanaChalla static void remove_eng_grp_mirroring(struct otx_cpt_eng_grp_info *dst_grp)
990d9110b0bSSrujanaChalla {
991d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *src_grp;
992d9110b0bSSrujanaChalla 
993d9110b0bSSrujanaChalla 	if (!dst_grp->mirror.is_ena)
994d9110b0bSSrujanaChalla 		return;
995d9110b0bSSrujanaChalla 
996d9110b0bSSrujanaChalla 	src_grp = &dst_grp->g->grp[dst_grp->mirror.idx];
997d9110b0bSSrujanaChalla 
998d9110b0bSSrujanaChalla 	src_grp->mirror.ref_count--;
999d9110b0bSSrujanaChalla 	dst_grp->mirror.is_ena = false;
1000d9110b0bSSrujanaChalla 	dst_grp->mirror.idx = 0;
1001d9110b0bSSrujanaChalla 	dst_grp->mirror.ref_count = 0;
1002d9110b0bSSrujanaChalla }
1003d9110b0bSSrujanaChalla 
update_requested_engs(struct otx_cpt_eng_grp_info * mirrored_eng_grp,struct otx_cpt_engines * engs,int engs_cnt)1004d9110b0bSSrujanaChalla static void update_requested_engs(struct otx_cpt_eng_grp_info *mirrored_eng_grp,
1005d9110b0bSSrujanaChalla 				  struct otx_cpt_engines *engs, int engs_cnt)
1006d9110b0bSSrujanaChalla {
1007d9110b0bSSrujanaChalla 	struct otx_cpt_engs_rsvd *mirrored_engs;
1008d9110b0bSSrujanaChalla 	int i;
1009d9110b0bSSrujanaChalla 
1010d9110b0bSSrujanaChalla 	for (i = 0; i < engs_cnt; i++) {
1011d9110b0bSSrujanaChalla 		mirrored_engs = find_engines_by_type(mirrored_eng_grp,
1012d9110b0bSSrujanaChalla 						     engs[i].type);
1013d9110b0bSSrujanaChalla 		if (!mirrored_engs)
1014d9110b0bSSrujanaChalla 			continue;
1015d9110b0bSSrujanaChalla 
1016d9110b0bSSrujanaChalla 		/*
1017d9110b0bSSrujanaChalla 		 * If mirrored group has this type of engines attached then
1018d9110b0bSSrujanaChalla 		 * there are 3 scenarios possible:
1019d9110b0bSSrujanaChalla 		 * 1) mirrored_engs.count == engs[i].count then all engines
1020d9110b0bSSrujanaChalla 		 * from mirrored engine group will be shared with this engine
1021d9110b0bSSrujanaChalla 		 * group
1022d9110b0bSSrujanaChalla 		 * 2) mirrored_engs.count > engs[i].count then only a subset of
1023d9110b0bSSrujanaChalla 		 * engines from mirrored engine group will be shared with this
1024d9110b0bSSrujanaChalla 		 * engine group
1025d9110b0bSSrujanaChalla 		 * 3) mirrored_engs.count < engs[i].count then all engines
1026d9110b0bSSrujanaChalla 		 * from mirrored engine group will be shared with this group
1027d9110b0bSSrujanaChalla 		 * and additional engines will be reserved for exclusively use
1028d9110b0bSSrujanaChalla 		 * by this engine group
1029d9110b0bSSrujanaChalla 		 */
1030d9110b0bSSrujanaChalla 		engs[i].count -= mirrored_engs->count;
1031d9110b0bSSrujanaChalla 	}
1032d9110b0bSSrujanaChalla }
1033d9110b0bSSrujanaChalla 
find_mirrored_eng_grp(struct otx_cpt_eng_grp_info * grp)1034d9110b0bSSrujanaChalla static struct otx_cpt_eng_grp_info *find_mirrored_eng_grp(
1035d9110b0bSSrujanaChalla 					struct otx_cpt_eng_grp_info *grp)
1036d9110b0bSSrujanaChalla {
1037d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grps *eng_grps = grp->g;
1038d9110b0bSSrujanaChalla 	int i;
1039d9110b0bSSrujanaChalla 
1040d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++) {
1041d9110b0bSSrujanaChalla 		if (!eng_grps->grp[i].is_enabled)
1042d9110b0bSSrujanaChalla 			continue;
1043d9110b0bSSrujanaChalla 		if (eng_grps->grp[i].ucode[0].type)
1044d9110b0bSSrujanaChalla 			continue;
1045d9110b0bSSrujanaChalla 		if (grp->idx == i)
1046d9110b0bSSrujanaChalla 			continue;
1047d9110b0bSSrujanaChalla 		if (!strncasecmp(eng_grps->grp[i].ucode[0].ver_str,
1048d9110b0bSSrujanaChalla 				 grp->ucode[0].ver_str,
1049d9110b0bSSrujanaChalla 				 OTX_CPT_UCODE_VER_STR_SZ))
1050d9110b0bSSrujanaChalla 			return &eng_grps->grp[i];
1051d9110b0bSSrujanaChalla 	}
1052d9110b0bSSrujanaChalla 
1053d9110b0bSSrujanaChalla 	return NULL;
1054d9110b0bSSrujanaChalla }
1055d9110b0bSSrujanaChalla 
find_unused_eng_grp(struct otx_cpt_eng_grps * eng_grps)1056d9110b0bSSrujanaChalla static struct otx_cpt_eng_grp_info *find_unused_eng_grp(
1057d9110b0bSSrujanaChalla 					struct otx_cpt_eng_grps *eng_grps)
1058d9110b0bSSrujanaChalla {
1059d9110b0bSSrujanaChalla 	int i;
1060d9110b0bSSrujanaChalla 
1061d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++) {
1062d9110b0bSSrujanaChalla 		if (!eng_grps->grp[i].is_enabled)
1063d9110b0bSSrujanaChalla 			return &eng_grps->grp[i];
1064d9110b0bSSrujanaChalla 	}
1065d9110b0bSSrujanaChalla 	return NULL;
1066d9110b0bSSrujanaChalla }
1067d9110b0bSSrujanaChalla 
eng_grp_update_masks(struct device * dev,struct otx_cpt_eng_grp_info * eng_grp)1068d9110b0bSSrujanaChalla static int eng_grp_update_masks(struct device *dev,
1069d9110b0bSSrujanaChalla 				struct otx_cpt_eng_grp_info *eng_grp)
1070d9110b0bSSrujanaChalla {
1071d9110b0bSSrujanaChalla 	struct otx_cpt_engs_rsvd *engs, *mirrored_engs;
1072d9110b0bSSrujanaChalla 	struct otx_cpt_bitmap tmp_bmap = { {0} };
1073d9110b0bSSrujanaChalla 	int i, j, cnt, max_cnt;
1074d9110b0bSSrujanaChalla 	int bit;
1075d9110b0bSSrujanaChalla 
1076d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
1077d9110b0bSSrujanaChalla 		engs = &eng_grp->engs[i];
1078d9110b0bSSrujanaChalla 		if (!engs->type)
1079d9110b0bSSrujanaChalla 			continue;
1080d9110b0bSSrujanaChalla 		if (engs->count <= 0)
1081d9110b0bSSrujanaChalla 			continue;
1082d9110b0bSSrujanaChalla 
1083d9110b0bSSrujanaChalla 		switch (engs->type) {
1084d9110b0bSSrujanaChalla 		case OTX_CPT_SE_TYPES:
1085d9110b0bSSrujanaChalla 			max_cnt = eng_grp->g->avail.max_se_cnt;
1086d9110b0bSSrujanaChalla 			break;
1087d9110b0bSSrujanaChalla 
1088d9110b0bSSrujanaChalla 		case OTX_CPT_AE_TYPES:
1089d9110b0bSSrujanaChalla 			max_cnt = eng_grp->g->avail.max_ae_cnt;
1090d9110b0bSSrujanaChalla 			break;
1091d9110b0bSSrujanaChalla 
1092d9110b0bSSrujanaChalla 		default:
10930a8f5989SChristophe JAILLET 			dev_err(dev, "Invalid engine type %d\n", engs->type);
1094d9110b0bSSrujanaChalla 			return -EINVAL;
1095d9110b0bSSrujanaChalla 		}
1096d9110b0bSSrujanaChalla 
1097d9110b0bSSrujanaChalla 		cnt = engs->count;
1098d9110b0bSSrujanaChalla 		WARN_ON(engs->offset + max_cnt > OTX_CPT_MAX_ENGINES);
1099d9110b0bSSrujanaChalla 		bitmap_zero(tmp_bmap.bits, eng_grp->g->engs_num);
1100d9110b0bSSrujanaChalla 		for (j = engs->offset; j < engs->offset + max_cnt; j++) {
1101d9110b0bSSrujanaChalla 			if (!eng_grp->g->eng_ref_cnt[j]) {
1102d9110b0bSSrujanaChalla 				bitmap_set(tmp_bmap.bits, j, 1);
1103d9110b0bSSrujanaChalla 				cnt--;
1104d9110b0bSSrujanaChalla 				if (!cnt)
1105d9110b0bSSrujanaChalla 					break;
1106d9110b0bSSrujanaChalla 			}
1107d9110b0bSSrujanaChalla 		}
1108d9110b0bSSrujanaChalla 
1109d9110b0bSSrujanaChalla 		if (cnt)
1110d9110b0bSSrujanaChalla 			return -ENOSPC;
1111d9110b0bSSrujanaChalla 
1112d9110b0bSSrujanaChalla 		bitmap_copy(engs->bmap, tmp_bmap.bits, eng_grp->g->engs_num);
1113d9110b0bSSrujanaChalla 	}
1114d9110b0bSSrujanaChalla 
1115d9110b0bSSrujanaChalla 	if (!eng_grp->mirror.is_ena)
1116d9110b0bSSrujanaChalla 		return 0;
1117d9110b0bSSrujanaChalla 
1118d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ETYPES_PER_GRP; i++) {
1119d9110b0bSSrujanaChalla 		engs = &eng_grp->engs[i];
1120d9110b0bSSrujanaChalla 		if (!engs->type)
1121d9110b0bSSrujanaChalla 			continue;
1122d9110b0bSSrujanaChalla 
1123d9110b0bSSrujanaChalla 		mirrored_engs = find_engines_by_type(
1124d9110b0bSSrujanaChalla 					&eng_grp->g->grp[eng_grp->mirror.idx],
1125d9110b0bSSrujanaChalla 					engs->type);
1126d9110b0bSSrujanaChalla 		WARN_ON(!mirrored_engs && engs->count <= 0);
1127d9110b0bSSrujanaChalla 		if (!mirrored_engs)
1128d9110b0bSSrujanaChalla 			continue;
1129d9110b0bSSrujanaChalla 
1130d9110b0bSSrujanaChalla 		bitmap_copy(tmp_bmap.bits, mirrored_engs->bmap,
1131d9110b0bSSrujanaChalla 			    eng_grp->g->engs_num);
1132d9110b0bSSrujanaChalla 		if (engs->count < 0) {
1133d9110b0bSSrujanaChalla 			bit = find_first_bit(mirrored_engs->bmap,
1134d9110b0bSSrujanaChalla 					     eng_grp->g->engs_num);
1135d9110b0bSSrujanaChalla 			bitmap_clear(tmp_bmap.bits, bit, -engs->count);
1136d9110b0bSSrujanaChalla 		}
1137d9110b0bSSrujanaChalla 		bitmap_or(engs->bmap, engs->bmap, tmp_bmap.bits,
1138d9110b0bSSrujanaChalla 			  eng_grp->g->engs_num);
1139d9110b0bSSrujanaChalla 	}
1140d9110b0bSSrujanaChalla 	return 0;
1141d9110b0bSSrujanaChalla }
1142d9110b0bSSrujanaChalla 
delete_engine_group(struct device * dev,struct otx_cpt_eng_grp_info * eng_grp)1143d9110b0bSSrujanaChalla static int delete_engine_group(struct device *dev,
1144d9110b0bSSrujanaChalla 			       struct otx_cpt_eng_grp_info *eng_grp)
1145d9110b0bSSrujanaChalla {
1146d9110b0bSSrujanaChalla 	int i, ret;
1147d9110b0bSSrujanaChalla 
1148d9110b0bSSrujanaChalla 	if (!eng_grp->is_enabled)
1149d9110b0bSSrujanaChalla 		return -EINVAL;
1150d9110b0bSSrujanaChalla 
1151d9110b0bSSrujanaChalla 	if (eng_grp->mirror.ref_count) {
11520a8f5989SChristophe JAILLET 		dev_err(dev, "Can't delete engine_group%d as it is used by engine_group(s):",
1153d9110b0bSSrujanaChalla 			eng_grp->idx);
1154d9110b0bSSrujanaChalla 		for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++) {
1155d9110b0bSSrujanaChalla 			if (eng_grp->g->grp[i].mirror.is_ena &&
1156d9110b0bSSrujanaChalla 			    eng_grp->g->grp[i].mirror.idx == eng_grp->idx)
11570a8f5989SChristophe JAILLET 				pr_cont(" %d", i);
1158d9110b0bSSrujanaChalla 		}
11590a8f5989SChristophe JAILLET 		pr_cont("\n");
1160d9110b0bSSrujanaChalla 		return -EINVAL;
1161d9110b0bSSrujanaChalla 	}
1162d9110b0bSSrujanaChalla 
1163d9110b0bSSrujanaChalla 	/* Removing engine group mirroring if enabled */
1164d9110b0bSSrujanaChalla 	remove_eng_grp_mirroring(eng_grp);
1165d9110b0bSSrujanaChalla 
1166d9110b0bSSrujanaChalla 	/* Disable engine group */
1167d9110b0bSSrujanaChalla 	ret = disable_eng_grp(dev, eng_grp, eng_grp->g->obj);
1168d9110b0bSSrujanaChalla 	if (ret)
1169d9110b0bSSrujanaChalla 		return ret;
1170d9110b0bSSrujanaChalla 
1171d9110b0bSSrujanaChalla 	/* Release all engines held by this engine group */
1172d9110b0bSSrujanaChalla 	ret = release_engines(dev, eng_grp);
1173d9110b0bSSrujanaChalla 	if (ret)
1174d9110b0bSSrujanaChalla 		return ret;
1175d9110b0bSSrujanaChalla 
1176d9110b0bSSrujanaChalla 	device_remove_file(dev, &eng_grp->info_attr);
1177d9110b0bSSrujanaChalla 	eng_grp->is_enabled = false;
1178d9110b0bSSrujanaChalla 
1179d9110b0bSSrujanaChalla 	return 0;
1180d9110b0bSSrujanaChalla }
1181d9110b0bSSrujanaChalla 
validate_1_ucode_scenario(struct device * dev,struct otx_cpt_eng_grp_info * eng_grp,struct otx_cpt_engines * engs,int engs_cnt)1182d9110b0bSSrujanaChalla static int validate_1_ucode_scenario(struct device *dev,
1183d9110b0bSSrujanaChalla 				     struct otx_cpt_eng_grp_info *eng_grp,
1184d9110b0bSSrujanaChalla 				     struct otx_cpt_engines *engs, int engs_cnt)
1185d9110b0bSSrujanaChalla {
1186d9110b0bSSrujanaChalla 	int i;
1187d9110b0bSSrujanaChalla 
1188d9110b0bSSrujanaChalla 	/* Verify that ucode loaded supports requested engine types */
1189d9110b0bSSrujanaChalla 	for (i = 0; i < engs_cnt; i++) {
1190d9110b0bSSrujanaChalla 		if (!otx_cpt_uc_supports_eng_type(&eng_grp->ucode[0],
1191d9110b0bSSrujanaChalla 						  engs[i].type)) {
1192d9110b0bSSrujanaChalla 			dev_err(dev,
11930a8f5989SChristophe JAILLET 				"Microcode %s does not support %s engines\n",
1194d9110b0bSSrujanaChalla 				eng_grp->ucode[0].filename,
1195d9110b0bSSrujanaChalla 				get_eng_type_str(engs[i].type));
1196d9110b0bSSrujanaChalla 			return -EINVAL;
1197d9110b0bSSrujanaChalla 		}
1198d9110b0bSSrujanaChalla 	}
1199d9110b0bSSrujanaChalla 	return 0;
1200d9110b0bSSrujanaChalla }
1201d9110b0bSSrujanaChalla 
update_ucode_ptrs(struct otx_cpt_eng_grp_info * eng_grp)1202d9110b0bSSrujanaChalla static void update_ucode_ptrs(struct otx_cpt_eng_grp_info *eng_grp)
1203d9110b0bSSrujanaChalla {
1204d9110b0bSSrujanaChalla 	struct otx_cpt_ucode *ucode;
1205d9110b0bSSrujanaChalla 
1206d9110b0bSSrujanaChalla 	if (eng_grp->mirror.is_ena)
1207d9110b0bSSrujanaChalla 		ucode = &eng_grp->g->grp[eng_grp->mirror.idx].ucode[0];
1208d9110b0bSSrujanaChalla 	else
1209d9110b0bSSrujanaChalla 		ucode = &eng_grp->ucode[0];
1210d9110b0bSSrujanaChalla 	WARN_ON(!eng_grp->engs[0].type);
1211d9110b0bSSrujanaChalla 	eng_grp->engs[0].ucode = ucode;
1212d9110b0bSSrujanaChalla }
1213d9110b0bSSrujanaChalla 
create_engine_group(struct device * dev,struct otx_cpt_eng_grps * eng_grps,struct otx_cpt_engines * engs,int engs_cnt,void * ucode_data[],int ucodes_cnt,bool use_uc_from_tar_arch)1214d9110b0bSSrujanaChalla static int create_engine_group(struct device *dev,
1215d9110b0bSSrujanaChalla 			       struct otx_cpt_eng_grps *eng_grps,
1216d9110b0bSSrujanaChalla 			       struct otx_cpt_engines *engs, int engs_cnt,
1217d9110b0bSSrujanaChalla 			       void *ucode_data[], int ucodes_cnt,
1218d9110b0bSSrujanaChalla 			       bool use_uc_from_tar_arch)
1219d9110b0bSSrujanaChalla {
1220d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *mirrored_eng_grp;
1221d9110b0bSSrujanaChalla 	struct tar_ucode_info_t *tar_info;
1222d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *eng_grp;
1223d9110b0bSSrujanaChalla 	int i, ret = 0;
1224d9110b0bSSrujanaChalla 
1225d9110b0bSSrujanaChalla 	if (ucodes_cnt > OTX_CPT_MAX_ETYPES_PER_GRP)
1226d9110b0bSSrujanaChalla 		return -EINVAL;
1227d9110b0bSSrujanaChalla 
1228d9110b0bSSrujanaChalla 	/* Validate if requested engine types are supported by this device */
1229d9110b0bSSrujanaChalla 	for (i = 0; i < engs_cnt; i++)
1230d9110b0bSSrujanaChalla 		if (!dev_supports_eng_type(eng_grps, engs[i].type)) {
12310a8f5989SChristophe JAILLET 			dev_err(dev, "Device does not support %s engines\n",
1232d9110b0bSSrujanaChalla 				get_eng_type_str(engs[i].type));
1233d9110b0bSSrujanaChalla 			return -EPERM;
1234d9110b0bSSrujanaChalla 		}
1235d9110b0bSSrujanaChalla 
1236d9110b0bSSrujanaChalla 	/* Find engine group which is not used */
1237d9110b0bSSrujanaChalla 	eng_grp = find_unused_eng_grp(eng_grps);
1238d9110b0bSSrujanaChalla 	if (!eng_grp) {
12390a8f5989SChristophe JAILLET 		dev_err(dev, "Error all engine groups are being used\n");
1240d9110b0bSSrujanaChalla 		return -ENOSPC;
1241d9110b0bSSrujanaChalla 	}
1242d9110b0bSSrujanaChalla 
1243d9110b0bSSrujanaChalla 	/* Load ucode */
1244d9110b0bSSrujanaChalla 	for (i = 0; i < ucodes_cnt; i++) {
1245d9110b0bSSrujanaChalla 		if (use_uc_from_tar_arch) {
1246d9110b0bSSrujanaChalla 			tar_info = (struct tar_ucode_info_t *) ucode_data[i];
1247d9110b0bSSrujanaChalla 			eng_grp->ucode[i] = tar_info->ucode;
1248d9110b0bSSrujanaChalla 			ret = copy_ucode_to_dma_mem(dev, &eng_grp->ucode[i],
1249d9110b0bSSrujanaChalla 						    tar_info->ucode_ptr);
1250d9110b0bSSrujanaChalla 		} else
1251d9110b0bSSrujanaChalla 			ret = ucode_load(dev, &eng_grp->ucode[i],
1252d9110b0bSSrujanaChalla 					 (char *) ucode_data[i]);
1253d9110b0bSSrujanaChalla 		if (ret)
1254d9110b0bSSrujanaChalla 			goto err_ucode_unload;
1255d9110b0bSSrujanaChalla 	}
1256d9110b0bSSrujanaChalla 
1257d9110b0bSSrujanaChalla 	/* Validate scenario where 1 ucode is used */
1258d9110b0bSSrujanaChalla 	ret = validate_1_ucode_scenario(dev, eng_grp, engs, engs_cnt);
1259d9110b0bSSrujanaChalla 	if (ret)
1260d9110b0bSSrujanaChalla 		goto err_ucode_unload;
1261d9110b0bSSrujanaChalla 
1262d9110b0bSSrujanaChalla 	/* Check if this group mirrors another existing engine group */
1263d9110b0bSSrujanaChalla 	mirrored_eng_grp = find_mirrored_eng_grp(eng_grp);
1264d9110b0bSSrujanaChalla 	if (mirrored_eng_grp) {
1265d9110b0bSSrujanaChalla 		/* Setup mirroring */
1266d9110b0bSSrujanaChalla 		setup_eng_grp_mirroring(eng_grp, mirrored_eng_grp);
1267d9110b0bSSrujanaChalla 
1268d9110b0bSSrujanaChalla 		/*
1269d9110b0bSSrujanaChalla 		 * Update count of requested engines because some
1270d9110b0bSSrujanaChalla 		 * of them might be shared with mirrored group
1271d9110b0bSSrujanaChalla 		 */
1272d9110b0bSSrujanaChalla 		update_requested_engs(mirrored_eng_grp, engs, engs_cnt);
1273d9110b0bSSrujanaChalla 	}
1274d9110b0bSSrujanaChalla 
1275d9110b0bSSrujanaChalla 	/* Reserve engines */
1276d9110b0bSSrujanaChalla 	ret = reserve_engines(dev, eng_grp, engs, engs_cnt);
1277d9110b0bSSrujanaChalla 	if (ret)
1278d9110b0bSSrujanaChalla 		goto err_ucode_unload;
1279d9110b0bSSrujanaChalla 
1280d9110b0bSSrujanaChalla 	/* Update ucode pointers used by engines */
1281d9110b0bSSrujanaChalla 	update_ucode_ptrs(eng_grp);
1282d9110b0bSSrujanaChalla 
1283d9110b0bSSrujanaChalla 	/* Update engine masks used by this group */
1284d9110b0bSSrujanaChalla 	ret = eng_grp_update_masks(dev, eng_grp);
1285d9110b0bSSrujanaChalla 	if (ret)
1286d9110b0bSSrujanaChalla 		goto err_release_engs;
1287d9110b0bSSrujanaChalla 
1288d9110b0bSSrujanaChalla 	/* Create sysfs entry for engine group info */
1289d9110b0bSSrujanaChalla 	ret = create_sysfs_eng_grps_info(dev, eng_grp);
1290d9110b0bSSrujanaChalla 	if (ret)
1291d9110b0bSSrujanaChalla 		goto err_release_engs;
1292d9110b0bSSrujanaChalla 
1293d9110b0bSSrujanaChalla 	/* Enable engine group */
1294d9110b0bSSrujanaChalla 	ret = enable_eng_grp(eng_grp, eng_grps->obj);
1295d9110b0bSSrujanaChalla 	if (ret)
1296d9110b0bSSrujanaChalla 		goto err_release_engs;
1297d9110b0bSSrujanaChalla 
1298d9110b0bSSrujanaChalla 	/*
1299d9110b0bSSrujanaChalla 	 * If this engine group mirrors another engine group
1300d9110b0bSSrujanaChalla 	 * then we need to unload ucode as we will use ucode
1301d9110b0bSSrujanaChalla 	 * from mirrored engine group
1302d9110b0bSSrujanaChalla 	 */
1303d9110b0bSSrujanaChalla 	if (eng_grp->mirror.is_ena)
1304d9110b0bSSrujanaChalla 		ucode_unload(dev, &eng_grp->ucode[0]);
1305d9110b0bSSrujanaChalla 
1306d9110b0bSSrujanaChalla 	eng_grp->is_enabled = true;
1307d9110b0bSSrujanaChalla 	if (eng_grp->mirror.is_ena)
1308d9110b0bSSrujanaChalla 		dev_info(dev,
13090a8f5989SChristophe JAILLET 			 "Engine_group%d: reuse microcode %s from group %d\n",
1310d9110b0bSSrujanaChalla 			 eng_grp->idx, mirrored_eng_grp->ucode[0].ver_str,
1311d9110b0bSSrujanaChalla 			 mirrored_eng_grp->idx);
1312d9110b0bSSrujanaChalla 	else
13130a8f5989SChristophe JAILLET 		dev_info(dev, "Engine_group%d: microcode loaded %s\n",
1314d9110b0bSSrujanaChalla 			 eng_grp->idx, eng_grp->ucode[0].ver_str);
1315d9110b0bSSrujanaChalla 
1316d9110b0bSSrujanaChalla 	return 0;
1317d9110b0bSSrujanaChalla 
1318d9110b0bSSrujanaChalla err_release_engs:
1319d9110b0bSSrujanaChalla 	release_engines(dev, eng_grp);
1320d9110b0bSSrujanaChalla err_ucode_unload:
1321d9110b0bSSrujanaChalla 	ucode_unload(dev, &eng_grp->ucode[0]);
1322d9110b0bSSrujanaChalla 	return ret;
1323d9110b0bSSrujanaChalla }
1324d9110b0bSSrujanaChalla 
ucode_load_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1325d9110b0bSSrujanaChalla static ssize_t ucode_load_store(struct device *dev,
1326d9110b0bSSrujanaChalla 				struct device_attribute *attr,
1327d9110b0bSSrujanaChalla 				const char *buf, size_t count)
1328d9110b0bSSrujanaChalla {
1329d9110b0bSSrujanaChalla 	struct otx_cpt_engines engs[OTX_CPT_MAX_ETYPES_PER_GRP] = { {0} };
1330d9110b0bSSrujanaChalla 	char *ucode_filename[OTX_CPT_MAX_ETYPES_PER_GRP];
1331d9110b0bSSrujanaChalla 	char tmp_buf[OTX_CPT_UCODE_NAME_LENGTH] = { 0 };
1332d9110b0bSSrujanaChalla 	char *start, *val, *err_msg, *tmp;
1333d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grps *eng_grps;
1334d9110b0bSSrujanaChalla 	int grp_idx = 0, ret = -EINVAL;
1335d9110b0bSSrujanaChalla 	bool has_se, has_ie, has_ae;
1336d9110b0bSSrujanaChalla 	int del_grp_idx = -1;
1337d9110b0bSSrujanaChalla 	int ucode_idx = 0;
1338d9110b0bSSrujanaChalla 
1339d9110b0bSSrujanaChalla 	if (strlen(buf) > OTX_CPT_UCODE_NAME_LENGTH)
1340d9110b0bSSrujanaChalla 		return -EINVAL;
1341d9110b0bSSrujanaChalla 
1342d9110b0bSSrujanaChalla 	eng_grps = container_of(attr, struct otx_cpt_eng_grps, ucode_load_attr);
1343d9110b0bSSrujanaChalla 	err_msg = "Invalid engine group format";
134428855860SWolfram Sang 	strscpy(tmp_buf, buf, OTX_CPT_UCODE_NAME_LENGTH);
1345d9110b0bSSrujanaChalla 	start = tmp_buf;
1346d9110b0bSSrujanaChalla 
1347d9110b0bSSrujanaChalla 	has_se = has_ie = has_ae = false;
1348d9110b0bSSrujanaChalla 
1349d9110b0bSSrujanaChalla 	for (;;) {
1350d9110b0bSSrujanaChalla 		val = strsep(&start, ";");
1351d9110b0bSSrujanaChalla 		if (!val)
1352d9110b0bSSrujanaChalla 			break;
1353d9110b0bSSrujanaChalla 		val = strim(val);
1354d9110b0bSSrujanaChalla 		if (!*val)
1355d9110b0bSSrujanaChalla 			continue;
1356d9110b0bSSrujanaChalla 
1357d9110b0bSSrujanaChalla 		if (!strncasecmp(val, "engine_group", 12)) {
1358d9110b0bSSrujanaChalla 			if (del_grp_idx != -1)
1359d9110b0bSSrujanaChalla 				goto err_print;
1360d9110b0bSSrujanaChalla 			tmp = strim(strsep(&val, ":"));
1361d9110b0bSSrujanaChalla 			if (!val)
1362d9110b0bSSrujanaChalla 				goto err_print;
1363d9110b0bSSrujanaChalla 			if (strlen(tmp) != 13)
1364d9110b0bSSrujanaChalla 				goto err_print;
1365d9110b0bSSrujanaChalla 			if (kstrtoint((tmp + 12), 10, &del_grp_idx))
1366d9110b0bSSrujanaChalla 				goto err_print;
1367d9110b0bSSrujanaChalla 			val = strim(val);
1368d9110b0bSSrujanaChalla 			if (strncasecmp(val, "null", 4))
1369d9110b0bSSrujanaChalla 				goto err_print;
1370d9110b0bSSrujanaChalla 			if (strlen(val) != 4)
1371d9110b0bSSrujanaChalla 				goto err_print;
1372d9110b0bSSrujanaChalla 		} else if (!strncasecmp(val, "se", 2) && strchr(val, ':')) {
1373d9110b0bSSrujanaChalla 			if (has_se || ucode_idx)
1374d9110b0bSSrujanaChalla 				goto err_print;
1375d9110b0bSSrujanaChalla 			tmp = strim(strsep(&val, ":"));
1376d9110b0bSSrujanaChalla 			if (!val)
1377d9110b0bSSrujanaChalla 				goto err_print;
1378d9110b0bSSrujanaChalla 			if (strlen(tmp) != 2)
1379d9110b0bSSrujanaChalla 				goto err_print;
1380d9110b0bSSrujanaChalla 			if (kstrtoint(strim(val), 10, &engs[grp_idx].count))
1381d9110b0bSSrujanaChalla 				goto err_print;
1382d9110b0bSSrujanaChalla 			engs[grp_idx++].type = OTX_CPT_SE_TYPES;
1383d9110b0bSSrujanaChalla 			has_se = true;
1384d9110b0bSSrujanaChalla 		} else if (!strncasecmp(val, "ae", 2) && strchr(val, ':')) {
1385d9110b0bSSrujanaChalla 			if (has_ae || ucode_idx)
1386d9110b0bSSrujanaChalla 				goto err_print;
1387d9110b0bSSrujanaChalla 			tmp = strim(strsep(&val, ":"));
1388d9110b0bSSrujanaChalla 			if (!val)
1389d9110b0bSSrujanaChalla 				goto err_print;
1390d9110b0bSSrujanaChalla 			if (strlen(tmp) != 2)
1391d9110b0bSSrujanaChalla 				goto err_print;
1392d9110b0bSSrujanaChalla 			if (kstrtoint(strim(val), 10, &engs[grp_idx].count))
1393d9110b0bSSrujanaChalla 				goto err_print;
1394d9110b0bSSrujanaChalla 			engs[grp_idx++].type = OTX_CPT_AE_TYPES;
1395d9110b0bSSrujanaChalla 			has_ae = true;
1396d9110b0bSSrujanaChalla 		} else {
1397d9110b0bSSrujanaChalla 			if (ucode_idx > 1)
1398d9110b0bSSrujanaChalla 				goto err_print;
1399d9110b0bSSrujanaChalla 			if (!strlen(val))
1400d9110b0bSSrujanaChalla 				goto err_print;
1401d9110b0bSSrujanaChalla 			if (strnstr(val, " ", strlen(val)))
1402d9110b0bSSrujanaChalla 				goto err_print;
1403d9110b0bSSrujanaChalla 			ucode_filename[ucode_idx++] = val;
1404d9110b0bSSrujanaChalla 		}
1405d9110b0bSSrujanaChalla 	}
1406d9110b0bSSrujanaChalla 
1407d9110b0bSSrujanaChalla 	/* Validate input parameters */
1408d9110b0bSSrujanaChalla 	if (del_grp_idx == -1) {
1409d9110b0bSSrujanaChalla 		if (!(grp_idx && ucode_idx))
1410d9110b0bSSrujanaChalla 			goto err_print;
1411d9110b0bSSrujanaChalla 
1412d9110b0bSSrujanaChalla 		if (ucode_idx > 1 && grp_idx < 2)
1413d9110b0bSSrujanaChalla 			goto err_print;
1414d9110b0bSSrujanaChalla 
1415d9110b0bSSrujanaChalla 		if (grp_idx > OTX_CPT_MAX_ETYPES_PER_GRP) {
1416d9110b0bSSrujanaChalla 			err_msg = "Error max 2 engine types can be attached";
1417d9110b0bSSrujanaChalla 			goto err_print;
1418d9110b0bSSrujanaChalla 		}
1419d9110b0bSSrujanaChalla 
1420d9110b0bSSrujanaChalla 	} else {
1421d9110b0bSSrujanaChalla 		if (del_grp_idx < 0 ||
1422d9110b0bSSrujanaChalla 		    del_grp_idx >= OTX_CPT_MAX_ENGINE_GROUPS) {
14230a8f5989SChristophe JAILLET 			dev_err(dev, "Invalid engine group index %d\n",
1424d9110b0bSSrujanaChalla 				del_grp_idx);
1425d9110b0bSSrujanaChalla 			ret = -EINVAL;
1426d9110b0bSSrujanaChalla 			return ret;
1427d9110b0bSSrujanaChalla 		}
1428d9110b0bSSrujanaChalla 
1429d9110b0bSSrujanaChalla 		if (!eng_grps->grp[del_grp_idx].is_enabled) {
14300a8f5989SChristophe JAILLET 			dev_err(dev, "Error engine_group%d is not configured\n",
1431d9110b0bSSrujanaChalla 				del_grp_idx);
1432d9110b0bSSrujanaChalla 			ret = -EINVAL;
1433d9110b0bSSrujanaChalla 			return ret;
1434d9110b0bSSrujanaChalla 		}
1435d9110b0bSSrujanaChalla 
1436d9110b0bSSrujanaChalla 		if (grp_idx || ucode_idx)
1437d9110b0bSSrujanaChalla 			goto err_print;
1438d9110b0bSSrujanaChalla 	}
1439d9110b0bSSrujanaChalla 
1440d9110b0bSSrujanaChalla 	mutex_lock(&eng_grps->lock);
1441d9110b0bSSrujanaChalla 
1442d9110b0bSSrujanaChalla 	if (eng_grps->is_rdonly) {
1443d9110b0bSSrujanaChalla 		dev_err(dev, "Disable VFs before modifying engine groups\n");
1444d9110b0bSSrujanaChalla 		ret = -EACCES;
1445d9110b0bSSrujanaChalla 		goto err_unlock;
1446d9110b0bSSrujanaChalla 	}
1447d9110b0bSSrujanaChalla 
1448d9110b0bSSrujanaChalla 	if (del_grp_idx == -1)
1449d9110b0bSSrujanaChalla 		/* create engine group */
1450d9110b0bSSrujanaChalla 		ret = create_engine_group(dev, eng_grps, engs, grp_idx,
1451d9110b0bSSrujanaChalla 					  (void **) ucode_filename,
1452d9110b0bSSrujanaChalla 					  ucode_idx, false);
1453d9110b0bSSrujanaChalla 	else
1454d9110b0bSSrujanaChalla 		/* delete engine group */
1455d9110b0bSSrujanaChalla 		ret = delete_engine_group(dev, &eng_grps->grp[del_grp_idx]);
1456d9110b0bSSrujanaChalla 	if (ret)
1457d9110b0bSSrujanaChalla 		goto err_unlock;
1458d9110b0bSSrujanaChalla 
1459d9110b0bSSrujanaChalla 	print_dbg_info(dev, eng_grps);
1460d9110b0bSSrujanaChalla err_unlock:
1461d9110b0bSSrujanaChalla 	mutex_unlock(&eng_grps->lock);
1462d9110b0bSSrujanaChalla 	return ret ? ret : count;
1463d9110b0bSSrujanaChalla err_print:
1464d9110b0bSSrujanaChalla 	dev_err(dev, "%s\n", err_msg);
1465d9110b0bSSrujanaChalla 
1466d9110b0bSSrujanaChalla 	return ret;
1467d9110b0bSSrujanaChalla }
1468d9110b0bSSrujanaChalla 
otx_cpt_try_create_default_eng_grps(struct pci_dev * pdev,struct otx_cpt_eng_grps * eng_grps,int pf_type)1469d9110b0bSSrujanaChalla int otx_cpt_try_create_default_eng_grps(struct pci_dev *pdev,
1470d9110b0bSSrujanaChalla 					struct otx_cpt_eng_grps *eng_grps,
1471d9110b0bSSrujanaChalla 					int pf_type)
1472d9110b0bSSrujanaChalla {
1473a05b1c15SHerbert Xu 	struct tar_ucode_info_t *tar_info[OTX_CPT_MAX_ETYPES_PER_GRP] = {};
1474a05b1c15SHerbert Xu 	struct otx_cpt_engines engs[OTX_CPT_MAX_ETYPES_PER_GRP] = {};
1475d9110b0bSSrujanaChalla 	struct tar_arch_info_t *tar_arch = NULL;
1476d9110b0bSSrujanaChalla 	char *tar_filename;
1477d9110b0bSSrujanaChalla 	int i, ret = 0;
1478d9110b0bSSrujanaChalla 
1479d9110b0bSSrujanaChalla 	mutex_lock(&eng_grps->lock);
1480d9110b0bSSrujanaChalla 
1481d9110b0bSSrujanaChalla 	/*
1482d9110b0bSSrujanaChalla 	 * We don't create engine group for kernel crypto if attempt to create
1483d9110b0bSSrujanaChalla 	 * it was already made (when user enabled VFs for the first time)
1484d9110b0bSSrujanaChalla 	 */
1485d9110b0bSSrujanaChalla 	if (eng_grps->is_first_try)
1486d9110b0bSSrujanaChalla 		goto unlock_mutex;
1487d9110b0bSSrujanaChalla 	eng_grps->is_first_try = true;
1488d9110b0bSSrujanaChalla 
1489d9110b0bSSrujanaChalla 	/* We create group for kcrypto only if no groups are configured */
1490d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++)
1491d9110b0bSSrujanaChalla 		if (eng_grps->grp[i].is_enabled)
1492d9110b0bSSrujanaChalla 			goto unlock_mutex;
1493d9110b0bSSrujanaChalla 
1494d9110b0bSSrujanaChalla 	switch (pf_type) {
1495d9110b0bSSrujanaChalla 	case OTX_CPT_AE:
1496d9110b0bSSrujanaChalla 	case OTX_CPT_SE:
1497d9110b0bSSrujanaChalla 		tar_filename = OTX_CPT_UCODE_TAR_FILE_NAME;
1498d9110b0bSSrujanaChalla 		break;
1499d9110b0bSSrujanaChalla 
1500d9110b0bSSrujanaChalla 	default:
1501d9110b0bSSrujanaChalla 		dev_err(&pdev->dev, "Unknown PF type %d\n", pf_type);
1502d9110b0bSSrujanaChalla 		ret = -EINVAL;
1503d9110b0bSSrujanaChalla 		goto unlock_mutex;
1504d9110b0bSSrujanaChalla 	}
1505d9110b0bSSrujanaChalla 
1506d9110b0bSSrujanaChalla 	tar_arch = load_tar_archive(&pdev->dev, tar_filename);
1507d9110b0bSSrujanaChalla 	if (!tar_arch)
1508d9110b0bSSrujanaChalla 		goto unlock_mutex;
1509d9110b0bSSrujanaChalla 
1510d9110b0bSSrujanaChalla 	/*
1511d9110b0bSSrujanaChalla 	 * If device supports SE engines and there is SE microcode in tar
1512d9110b0bSSrujanaChalla 	 * archive try to create engine group with SE engines for kernel
1513d9110b0bSSrujanaChalla 	 * crypto functionality (symmetric crypto)
1514d9110b0bSSrujanaChalla 	 */
1515d9110b0bSSrujanaChalla 	tar_info[0] = get_uc_from_tar_archive(tar_arch, OTX_CPT_SE_TYPES);
1516d9110b0bSSrujanaChalla 	if (tar_info[0] &&
1517d9110b0bSSrujanaChalla 	    dev_supports_eng_type(eng_grps, OTX_CPT_SE_TYPES)) {
1518d9110b0bSSrujanaChalla 
1519d9110b0bSSrujanaChalla 		engs[0].type = OTX_CPT_SE_TYPES;
1520d9110b0bSSrujanaChalla 		engs[0].count = eng_grps->avail.max_se_cnt;
1521d9110b0bSSrujanaChalla 
1522d9110b0bSSrujanaChalla 		ret = create_engine_group(&pdev->dev, eng_grps, engs, 1,
1523d9110b0bSSrujanaChalla 					  (void **) tar_info, 1, true);
1524d9110b0bSSrujanaChalla 		if (ret)
1525d9110b0bSSrujanaChalla 			goto release_tar_arch;
1526d9110b0bSSrujanaChalla 	}
1527d9110b0bSSrujanaChalla 	/*
1528d9110b0bSSrujanaChalla 	 * If device supports AE engines and there is AE microcode in tar
1529d9110b0bSSrujanaChalla 	 * archive try to create engine group with AE engines for asymmetric
1530d9110b0bSSrujanaChalla 	 * crypto functionality.
1531d9110b0bSSrujanaChalla 	 */
1532d9110b0bSSrujanaChalla 	tar_info[0] = get_uc_from_tar_archive(tar_arch, OTX_CPT_AE_TYPES);
1533d9110b0bSSrujanaChalla 	if (tar_info[0] &&
1534d9110b0bSSrujanaChalla 	    dev_supports_eng_type(eng_grps, OTX_CPT_AE_TYPES)) {
1535d9110b0bSSrujanaChalla 
1536d9110b0bSSrujanaChalla 		engs[0].type = OTX_CPT_AE_TYPES;
1537d9110b0bSSrujanaChalla 		engs[0].count = eng_grps->avail.max_ae_cnt;
1538d9110b0bSSrujanaChalla 
1539d9110b0bSSrujanaChalla 		ret = create_engine_group(&pdev->dev, eng_grps, engs, 1,
1540d9110b0bSSrujanaChalla 					  (void **) tar_info, 1, true);
1541d9110b0bSSrujanaChalla 		if (ret)
1542d9110b0bSSrujanaChalla 			goto release_tar_arch;
1543d9110b0bSSrujanaChalla 	}
1544d9110b0bSSrujanaChalla 
1545d9110b0bSSrujanaChalla 	print_dbg_info(&pdev->dev, eng_grps);
1546d9110b0bSSrujanaChalla release_tar_arch:
1547d9110b0bSSrujanaChalla 	release_tar_archive(tar_arch);
1548d9110b0bSSrujanaChalla unlock_mutex:
1549d9110b0bSSrujanaChalla 	mutex_unlock(&eng_grps->lock);
1550d9110b0bSSrujanaChalla 	return ret;
1551d9110b0bSSrujanaChalla }
1552d9110b0bSSrujanaChalla 
otx_cpt_set_eng_grps_is_rdonly(struct otx_cpt_eng_grps * eng_grps,bool is_rdonly)1553d9110b0bSSrujanaChalla void otx_cpt_set_eng_grps_is_rdonly(struct otx_cpt_eng_grps *eng_grps,
1554d9110b0bSSrujanaChalla 				    bool is_rdonly)
1555d9110b0bSSrujanaChalla {
1556d9110b0bSSrujanaChalla 	mutex_lock(&eng_grps->lock);
1557d9110b0bSSrujanaChalla 
1558d9110b0bSSrujanaChalla 	eng_grps->is_rdonly = is_rdonly;
1559d9110b0bSSrujanaChalla 
1560d9110b0bSSrujanaChalla 	mutex_unlock(&eng_grps->lock);
1561d9110b0bSSrujanaChalla }
1562d9110b0bSSrujanaChalla 
otx_cpt_disable_all_cores(struct otx_cpt_device * cpt)1563d9110b0bSSrujanaChalla void otx_cpt_disable_all_cores(struct otx_cpt_device *cpt)
1564d9110b0bSSrujanaChalla {
1565d9110b0bSSrujanaChalla 	int grp, timeout = 100;
1566d9110b0bSSrujanaChalla 	u64 reg;
1567d9110b0bSSrujanaChalla 
1568d9110b0bSSrujanaChalla 	/* Disengage the cores from groups */
1569d9110b0bSSrujanaChalla 	for (grp = 0; grp < OTX_CPT_MAX_ENGINE_GROUPS; grp++) {
1570d9110b0bSSrujanaChalla 		writeq(0, cpt->reg_base + OTX_CPT_PF_GX_EN(grp));
1571d9110b0bSSrujanaChalla 		udelay(CSR_DELAY);
1572d9110b0bSSrujanaChalla 	}
1573d9110b0bSSrujanaChalla 
1574d9110b0bSSrujanaChalla 	reg = readq(cpt->reg_base + OTX_CPT_PF_EXEC_BUSY);
1575d9110b0bSSrujanaChalla 	while (reg) {
1576d9110b0bSSrujanaChalla 		udelay(CSR_DELAY);
1577d9110b0bSSrujanaChalla 		reg = readq(cpt->reg_base + OTX_CPT_PF_EXEC_BUSY);
1578d9110b0bSSrujanaChalla 		if (timeout--) {
15790a8f5989SChristophe JAILLET 			dev_warn(&cpt->pdev->dev, "Cores still busy\n");
1580d9110b0bSSrujanaChalla 			break;
1581d9110b0bSSrujanaChalla 		}
1582d9110b0bSSrujanaChalla 	}
1583d9110b0bSSrujanaChalla 
1584d9110b0bSSrujanaChalla 	/* Disable the cores */
1585d9110b0bSSrujanaChalla 	writeq(0, cpt->reg_base + OTX_CPT_PF_EXE_CTL);
1586d9110b0bSSrujanaChalla }
1587d9110b0bSSrujanaChalla 
otx_cpt_cleanup_eng_grps(struct pci_dev * pdev,struct otx_cpt_eng_grps * eng_grps)1588d9110b0bSSrujanaChalla void otx_cpt_cleanup_eng_grps(struct pci_dev *pdev,
1589d9110b0bSSrujanaChalla 			      struct otx_cpt_eng_grps *eng_grps)
1590d9110b0bSSrujanaChalla {
1591d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *grp;
1592d9110b0bSSrujanaChalla 	int i, j;
1593d9110b0bSSrujanaChalla 
1594d9110b0bSSrujanaChalla 	mutex_lock(&eng_grps->lock);
1595d9110b0bSSrujanaChalla 	if (eng_grps->is_ucode_load_created) {
1596d9110b0bSSrujanaChalla 		device_remove_file(&pdev->dev,
1597d9110b0bSSrujanaChalla 				   &eng_grps->ucode_load_attr);
1598d9110b0bSSrujanaChalla 		eng_grps->is_ucode_load_created = false;
1599d9110b0bSSrujanaChalla 	}
1600d9110b0bSSrujanaChalla 
1601d9110b0bSSrujanaChalla 	/* First delete all mirroring engine groups */
1602d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++)
1603d9110b0bSSrujanaChalla 		if (eng_grps->grp[i].mirror.is_ena)
1604d9110b0bSSrujanaChalla 			delete_engine_group(&pdev->dev, &eng_grps->grp[i]);
1605d9110b0bSSrujanaChalla 
1606d9110b0bSSrujanaChalla 	/* Delete remaining engine groups */
1607d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++)
1608d9110b0bSSrujanaChalla 		delete_engine_group(&pdev->dev, &eng_grps->grp[i]);
1609d9110b0bSSrujanaChalla 
1610d9110b0bSSrujanaChalla 	/* Release memory */
1611d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++) {
1612d9110b0bSSrujanaChalla 		grp = &eng_grps->grp[i];
1613d9110b0bSSrujanaChalla 		for (j = 0; j < OTX_CPT_MAX_ETYPES_PER_GRP; j++) {
1614d9110b0bSSrujanaChalla 			kfree(grp->engs[j].bmap);
1615d9110b0bSSrujanaChalla 			grp->engs[j].bmap = NULL;
1616d9110b0bSSrujanaChalla 		}
1617d9110b0bSSrujanaChalla 	}
1618d9110b0bSSrujanaChalla 
1619d9110b0bSSrujanaChalla 	mutex_unlock(&eng_grps->lock);
1620d9110b0bSSrujanaChalla }
1621d9110b0bSSrujanaChalla 
otx_cpt_init_eng_grps(struct pci_dev * pdev,struct otx_cpt_eng_grps * eng_grps,int pf_type)1622d9110b0bSSrujanaChalla int otx_cpt_init_eng_grps(struct pci_dev *pdev,
1623d9110b0bSSrujanaChalla 			  struct otx_cpt_eng_grps *eng_grps, int pf_type)
1624d9110b0bSSrujanaChalla {
1625d9110b0bSSrujanaChalla 	struct otx_cpt_eng_grp_info *grp;
1626d9110b0bSSrujanaChalla 	int i, j, ret = 0;
1627d9110b0bSSrujanaChalla 
1628d9110b0bSSrujanaChalla 	mutex_init(&eng_grps->lock);
1629d9110b0bSSrujanaChalla 	eng_grps->obj = pci_get_drvdata(pdev);
1630d9110b0bSSrujanaChalla 	eng_grps->avail.se_cnt = eng_grps->avail.max_se_cnt;
1631d9110b0bSSrujanaChalla 	eng_grps->avail.ae_cnt = eng_grps->avail.max_ae_cnt;
1632d9110b0bSSrujanaChalla 
1633d9110b0bSSrujanaChalla 	eng_grps->engs_num = eng_grps->avail.max_se_cnt +
1634d9110b0bSSrujanaChalla 			     eng_grps->avail.max_ae_cnt;
1635d9110b0bSSrujanaChalla 	if (eng_grps->engs_num > OTX_CPT_MAX_ENGINES) {
1636d9110b0bSSrujanaChalla 		dev_err(&pdev->dev,
16370a8f5989SChristophe JAILLET 			"Number of engines %d > than max supported %d\n",
1638d9110b0bSSrujanaChalla 			eng_grps->engs_num, OTX_CPT_MAX_ENGINES);
1639d9110b0bSSrujanaChalla 		ret = -EINVAL;
1640d9110b0bSSrujanaChalla 		goto err;
1641d9110b0bSSrujanaChalla 	}
1642d9110b0bSSrujanaChalla 
1643d9110b0bSSrujanaChalla 	for (i = 0; i < OTX_CPT_MAX_ENGINE_GROUPS; i++) {
1644d9110b0bSSrujanaChalla 		grp = &eng_grps->grp[i];
1645d9110b0bSSrujanaChalla 		grp->g = eng_grps;
1646d9110b0bSSrujanaChalla 		grp->idx = i;
1647d9110b0bSSrujanaChalla 
1648d9110b0bSSrujanaChalla 		snprintf(grp->sysfs_info_name, OTX_CPT_UCODE_NAME_LENGTH,
1649d9110b0bSSrujanaChalla 			 "engine_group%d", i);
1650d9110b0bSSrujanaChalla 		for (j = 0; j < OTX_CPT_MAX_ETYPES_PER_GRP; j++) {
1651d9110b0bSSrujanaChalla 			grp->engs[j].bmap =
1652d9110b0bSSrujanaChalla 				kcalloc(BITS_TO_LONGS(eng_grps->engs_num),
1653d9110b0bSSrujanaChalla 					sizeof(long), GFP_KERNEL);
1654d9110b0bSSrujanaChalla 			if (!grp->engs[j].bmap) {
1655d9110b0bSSrujanaChalla 				ret = -ENOMEM;
1656d9110b0bSSrujanaChalla 				goto err;
1657d9110b0bSSrujanaChalla 			}
1658d9110b0bSSrujanaChalla 		}
1659d9110b0bSSrujanaChalla 	}
1660d9110b0bSSrujanaChalla 
1661d9110b0bSSrujanaChalla 	switch (pf_type) {
1662d9110b0bSSrujanaChalla 	case OTX_CPT_SE:
1663d9110b0bSSrujanaChalla 		/* OcteonTX 83XX SE CPT PF has only SE engines attached */
1664d9110b0bSSrujanaChalla 		eng_grps->eng_types_supported = 1 << OTX_CPT_SE_TYPES;
1665d9110b0bSSrujanaChalla 		break;
1666d9110b0bSSrujanaChalla 
1667d9110b0bSSrujanaChalla 	case OTX_CPT_AE:
1668d9110b0bSSrujanaChalla 		/* OcteonTX 83XX AE CPT PF has only AE engines attached */
1669d9110b0bSSrujanaChalla 		eng_grps->eng_types_supported = 1 << OTX_CPT_AE_TYPES;
1670d9110b0bSSrujanaChalla 		break;
1671d9110b0bSSrujanaChalla 
1672d9110b0bSSrujanaChalla 	default:
1673d9110b0bSSrujanaChalla 		dev_err(&pdev->dev, "Unknown PF type %d\n", pf_type);
1674d9110b0bSSrujanaChalla 		ret = -EINVAL;
1675d9110b0bSSrujanaChalla 		goto err;
1676d9110b0bSSrujanaChalla 	}
1677d9110b0bSSrujanaChalla 
1678d9110b0bSSrujanaChalla 	eng_grps->ucode_load_attr.show = NULL;
1679d9110b0bSSrujanaChalla 	eng_grps->ucode_load_attr.store = ucode_load_store;
1680d9110b0bSSrujanaChalla 	eng_grps->ucode_load_attr.attr.name = "ucode_load";
1681d9110b0bSSrujanaChalla 	eng_grps->ucode_load_attr.attr.mode = 0220;
1682d9110b0bSSrujanaChalla 	sysfs_attr_init(&eng_grps->ucode_load_attr.attr);
1683d9110b0bSSrujanaChalla 	ret = device_create_file(&pdev->dev,
1684d9110b0bSSrujanaChalla 				 &eng_grps->ucode_load_attr);
1685d9110b0bSSrujanaChalla 	if (ret)
1686d9110b0bSSrujanaChalla 		goto err;
1687d9110b0bSSrujanaChalla 	eng_grps->is_ucode_load_created = true;
1688d9110b0bSSrujanaChalla 
1689d9110b0bSSrujanaChalla 	print_dbg_info(&pdev->dev, eng_grps);
1690d9110b0bSSrujanaChalla 	return ret;
1691d9110b0bSSrujanaChalla err:
1692d9110b0bSSrujanaChalla 	otx_cpt_cleanup_eng_grps(pdev, eng_grps);
1693d9110b0bSSrujanaChalla 	return ret;
1694d9110b0bSSrujanaChalla }
1695