xref: /OK3568_Linux_fs/kernel/arch/powerpc/platforms/powernv/opal-flash.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * PowerNV OPAL Firmware Update Interface
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2013 IBM Corp.
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #define DEBUG
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/kernel.h>
11*4882a593Smuzhiyun #include <linux/reboot.h>
12*4882a593Smuzhiyun #include <linux/init.h>
13*4882a593Smuzhiyun #include <linux/kobject.h>
14*4882a593Smuzhiyun #include <linux/sysfs.h>
15*4882a593Smuzhiyun #include <linux/slab.h>
16*4882a593Smuzhiyun #include <linux/mm.h>
17*4882a593Smuzhiyun #include <linux/vmalloc.h>
18*4882a593Smuzhiyun #include <linux/pagemap.h>
19*4882a593Smuzhiyun #include <linux/delay.h>
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun #include <asm/opal.h>
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun /* FLASH status codes */
24*4882a593Smuzhiyun #define FLASH_NO_OP		-1099	/* No operation initiated by user */
25*4882a593Smuzhiyun #define FLASH_NO_AUTH		-9002	/* Not a service authority partition */
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun /* Validate image status values */
28*4882a593Smuzhiyun #define VALIDATE_IMG_READY	-1001	/* Image ready for validation */
29*4882a593Smuzhiyun #define VALIDATE_IMG_INCOMPLETE	-1002	/* User copied < VALIDATE_BUF_SIZE */
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun /* Manage image status values */
32*4882a593Smuzhiyun #define MANAGE_ACTIVE_ERR	-9001	/* Cannot overwrite active img */
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun /* Flash image status values */
35*4882a593Smuzhiyun #define FLASH_IMG_READY		0	/* Img ready for flash on reboot */
36*4882a593Smuzhiyun #define FLASH_INVALID_IMG	-1003	/* Flash image shorter than expected */
37*4882a593Smuzhiyun #define FLASH_IMG_NULL_DATA	-1004	/* Bad data in sg list entry */
38*4882a593Smuzhiyun #define FLASH_IMG_BAD_LEN	-1005	/* Bad length in sg list entry */
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun /* Manage operation tokens */
41*4882a593Smuzhiyun #define FLASH_REJECT_TMP_SIDE	0	/* Reject temporary fw image */
42*4882a593Smuzhiyun #define FLASH_COMMIT_TMP_SIDE	1	/* Commit temporary fw image */
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun /* Update tokens */
45*4882a593Smuzhiyun #define FLASH_UPDATE_CANCEL	0	/* Cancel update request */
46*4882a593Smuzhiyun #define FLASH_UPDATE_INIT	1	/* Initiate update */
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun /* Validate image update result tokens */
49*4882a593Smuzhiyun #define VALIDATE_TMP_UPDATE	0     /* T side will be updated */
50*4882a593Smuzhiyun #define VALIDATE_FLASH_AUTH	1     /* Partition does not have authority */
51*4882a593Smuzhiyun #define VALIDATE_INVALID_IMG	2     /* Candidate image is not valid */
52*4882a593Smuzhiyun #define VALIDATE_CUR_UNKNOWN	3     /* Current fixpack level is unknown */
53*4882a593Smuzhiyun /*
54*4882a593Smuzhiyun  * Current T side will be committed to P side before being replace with new
55*4882a593Smuzhiyun  * image, and the new image is downlevel from current image
56*4882a593Smuzhiyun  */
57*4882a593Smuzhiyun #define VALIDATE_TMP_COMMIT_DL	4
58*4882a593Smuzhiyun /*
59*4882a593Smuzhiyun  * Current T side will be committed to P side before being replaced with new
60*4882a593Smuzhiyun  * image
61*4882a593Smuzhiyun  */
62*4882a593Smuzhiyun #define VALIDATE_TMP_COMMIT	5
63*4882a593Smuzhiyun /*
64*4882a593Smuzhiyun  * T side will be updated with a downlevel image
65*4882a593Smuzhiyun  */
66*4882a593Smuzhiyun #define VALIDATE_TMP_UPDATE_DL	6
67*4882a593Smuzhiyun /*
68*4882a593Smuzhiyun  * The candidate image's release date is later than the system's firmware
69*4882a593Smuzhiyun  * service entitlement date - service warranty period has expired
70*4882a593Smuzhiyun  */
71*4882a593Smuzhiyun #define VALIDATE_OUT_OF_WRNTY	7
72*4882a593Smuzhiyun 
73*4882a593Smuzhiyun /* Validate buffer size */
74*4882a593Smuzhiyun #define VALIDATE_BUF_SIZE	4096
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun /* XXX: Assume candidate image size is <= 1GB */
77*4882a593Smuzhiyun #define MAX_IMAGE_SIZE	0x40000000
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun /* Image status */
80*4882a593Smuzhiyun enum {
81*4882a593Smuzhiyun 	IMAGE_INVALID,
82*4882a593Smuzhiyun 	IMAGE_LOADING,
83*4882a593Smuzhiyun 	IMAGE_READY,
84*4882a593Smuzhiyun };
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun /* Candidate image data */
87*4882a593Smuzhiyun struct image_data_t {
88*4882a593Smuzhiyun 	int		status;
89*4882a593Smuzhiyun 	void		*data;
90*4882a593Smuzhiyun 	uint32_t	size;
91*4882a593Smuzhiyun };
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun /* Candidate image header */
94*4882a593Smuzhiyun struct image_header_t {
95*4882a593Smuzhiyun 	uint16_t	magic;
96*4882a593Smuzhiyun 	uint16_t	version;
97*4882a593Smuzhiyun 	uint32_t	size;
98*4882a593Smuzhiyun };
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun struct validate_flash_t {
101*4882a593Smuzhiyun 	int		status;		/* Return status */
102*4882a593Smuzhiyun 	void		*buf;		/* Candidate image buffer */
103*4882a593Smuzhiyun 	uint32_t	buf_size;	/* Image size */
104*4882a593Smuzhiyun 	uint32_t	result;		/* Update results token */
105*4882a593Smuzhiyun };
106*4882a593Smuzhiyun 
107*4882a593Smuzhiyun struct manage_flash_t {
108*4882a593Smuzhiyun 	int status;		/* Return status */
109*4882a593Smuzhiyun };
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun struct update_flash_t {
112*4882a593Smuzhiyun 	int status;		/* Return status */
113*4882a593Smuzhiyun };
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun static struct image_header_t	image_header;
116*4882a593Smuzhiyun static struct image_data_t	image_data;
117*4882a593Smuzhiyun static struct validate_flash_t	validate_flash_data;
118*4882a593Smuzhiyun static struct manage_flash_t	manage_flash_data;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun /* Initialize update_flash_data status to No Operation */
121*4882a593Smuzhiyun static struct update_flash_t	update_flash_data = {
122*4882a593Smuzhiyun 	.status = FLASH_NO_OP,
123*4882a593Smuzhiyun };
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun static DEFINE_MUTEX(image_data_mutex);
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun /*
128*4882a593Smuzhiyun  * Validate candidate image
129*4882a593Smuzhiyun  */
opal_flash_validate(void)130*4882a593Smuzhiyun static inline void opal_flash_validate(void)
131*4882a593Smuzhiyun {
132*4882a593Smuzhiyun 	long ret;
133*4882a593Smuzhiyun 	void *buf = validate_flash_data.buf;
134*4882a593Smuzhiyun 	__be32 size = cpu_to_be32(validate_flash_data.buf_size);
135*4882a593Smuzhiyun 	__be32 result;
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun 	ret = opal_validate_flash(__pa(buf), &size, &result);
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 	validate_flash_data.status = ret;
140*4882a593Smuzhiyun 	validate_flash_data.buf_size = be32_to_cpu(size);
141*4882a593Smuzhiyun 	validate_flash_data.result = be32_to_cpu(result);
142*4882a593Smuzhiyun }
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun /*
145*4882a593Smuzhiyun  * Validate output format:
146*4882a593Smuzhiyun  *     validate result token
147*4882a593Smuzhiyun  *     current image version details
148*4882a593Smuzhiyun  *     new image version details
149*4882a593Smuzhiyun  */
validate_show(struct kobject * kobj,struct kobj_attribute * attr,char * buf)150*4882a593Smuzhiyun static ssize_t validate_show(struct kobject *kobj,
151*4882a593Smuzhiyun 			     struct kobj_attribute *attr, char *buf)
152*4882a593Smuzhiyun {
153*4882a593Smuzhiyun 	struct validate_flash_t *args_buf = &validate_flash_data;
154*4882a593Smuzhiyun 	int len;
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun 	/* Candidate image is not validated */
157*4882a593Smuzhiyun 	if (args_buf->status < VALIDATE_TMP_UPDATE) {
158*4882a593Smuzhiyun 		len = sprintf(buf, "%d\n", args_buf->status);
159*4882a593Smuzhiyun 		goto out;
160*4882a593Smuzhiyun 	}
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun 	/* Result token */
163*4882a593Smuzhiyun 	len = sprintf(buf, "%d\n", args_buf->result);
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	/* Current and candidate image version details */
166*4882a593Smuzhiyun 	if ((args_buf->result != VALIDATE_TMP_UPDATE) &&
167*4882a593Smuzhiyun 	    (args_buf->result < VALIDATE_CUR_UNKNOWN))
168*4882a593Smuzhiyun 		goto out;
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	if (args_buf->buf_size > (VALIDATE_BUF_SIZE - len)) {
171*4882a593Smuzhiyun 		memcpy(buf + len, args_buf->buf, VALIDATE_BUF_SIZE - len);
172*4882a593Smuzhiyun 		len = VALIDATE_BUF_SIZE;
173*4882a593Smuzhiyun 	} else {
174*4882a593Smuzhiyun 		memcpy(buf + len, args_buf->buf, args_buf->buf_size);
175*4882a593Smuzhiyun 		len += args_buf->buf_size;
176*4882a593Smuzhiyun 	}
177*4882a593Smuzhiyun out:
178*4882a593Smuzhiyun 	/* Set status to default */
179*4882a593Smuzhiyun 	args_buf->status = FLASH_NO_OP;
180*4882a593Smuzhiyun 	return len;
181*4882a593Smuzhiyun }
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun /*
184*4882a593Smuzhiyun  * Validate candidate firmware image
185*4882a593Smuzhiyun  *
186*4882a593Smuzhiyun  * Note:
187*4882a593Smuzhiyun  *   We are only interested in first 4K bytes of the
188*4882a593Smuzhiyun  *   candidate image.
189*4882a593Smuzhiyun  */
validate_store(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)190*4882a593Smuzhiyun static ssize_t validate_store(struct kobject *kobj,
191*4882a593Smuzhiyun 			      struct kobj_attribute *attr,
192*4882a593Smuzhiyun 			      const char *buf, size_t count)
193*4882a593Smuzhiyun {
194*4882a593Smuzhiyun 	struct validate_flash_t *args_buf = &validate_flash_data;
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	if (buf[0] != '1')
197*4882a593Smuzhiyun 		return -EINVAL;
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	mutex_lock(&image_data_mutex);
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun 	if (image_data.status != IMAGE_READY ||
202*4882a593Smuzhiyun 	    image_data.size < VALIDATE_BUF_SIZE) {
203*4882a593Smuzhiyun 		args_buf->result = VALIDATE_INVALID_IMG;
204*4882a593Smuzhiyun 		args_buf->status = VALIDATE_IMG_INCOMPLETE;
205*4882a593Smuzhiyun 		goto out;
206*4882a593Smuzhiyun 	}
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	/* Copy first 4k bytes of candidate image */
209*4882a593Smuzhiyun 	memcpy(args_buf->buf, image_data.data, VALIDATE_BUF_SIZE);
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	args_buf->status = VALIDATE_IMG_READY;
212*4882a593Smuzhiyun 	args_buf->buf_size = VALIDATE_BUF_SIZE;
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 	/* Validate candidate image */
215*4882a593Smuzhiyun 	opal_flash_validate();
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun out:
218*4882a593Smuzhiyun 	mutex_unlock(&image_data_mutex);
219*4882a593Smuzhiyun 	return count;
220*4882a593Smuzhiyun }
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun /*
223*4882a593Smuzhiyun  * Manage flash routine
224*4882a593Smuzhiyun  */
opal_flash_manage(uint8_t op)225*4882a593Smuzhiyun static inline void opal_flash_manage(uint8_t op)
226*4882a593Smuzhiyun {
227*4882a593Smuzhiyun 	struct manage_flash_t *const args_buf = &manage_flash_data;
228*4882a593Smuzhiyun 
229*4882a593Smuzhiyun 	args_buf->status = opal_manage_flash(op);
230*4882a593Smuzhiyun }
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun /*
233*4882a593Smuzhiyun  * Show manage flash status
234*4882a593Smuzhiyun  */
manage_show(struct kobject * kobj,struct kobj_attribute * attr,char * buf)235*4882a593Smuzhiyun static ssize_t manage_show(struct kobject *kobj,
236*4882a593Smuzhiyun 			   struct kobj_attribute *attr, char *buf)
237*4882a593Smuzhiyun {
238*4882a593Smuzhiyun 	struct manage_flash_t *const args_buf = &manage_flash_data;
239*4882a593Smuzhiyun 	int rc;
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	rc = sprintf(buf, "%d\n", args_buf->status);
242*4882a593Smuzhiyun 	/* Set status to default*/
243*4882a593Smuzhiyun 	args_buf->status = FLASH_NO_OP;
244*4882a593Smuzhiyun 	return rc;
245*4882a593Smuzhiyun }
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun /*
248*4882a593Smuzhiyun  * Manage operations:
249*4882a593Smuzhiyun  *   0 - Reject
250*4882a593Smuzhiyun  *   1 - Commit
251*4882a593Smuzhiyun  */
manage_store(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)252*4882a593Smuzhiyun static ssize_t manage_store(struct kobject *kobj,
253*4882a593Smuzhiyun 			    struct kobj_attribute *attr,
254*4882a593Smuzhiyun 			    const char *buf, size_t count)
255*4882a593Smuzhiyun {
256*4882a593Smuzhiyun 	uint8_t op;
257*4882a593Smuzhiyun 	switch (buf[0]) {
258*4882a593Smuzhiyun 	case '0':
259*4882a593Smuzhiyun 		op = FLASH_REJECT_TMP_SIDE;
260*4882a593Smuzhiyun 		break;
261*4882a593Smuzhiyun 	case '1':
262*4882a593Smuzhiyun 		op = FLASH_COMMIT_TMP_SIDE;
263*4882a593Smuzhiyun 		break;
264*4882a593Smuzhiyun 	default:
265*4882a593Smuzhiyun 		return -EINVAL;
266*4882a593Smuzhiyun 	}
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	/* commit/reject temporary image */
269*4882a593Smuzhiyun 	opal_flash_manage(op);
270*4882a593Smuzhiyun 	return count;
271*4882a593Smuzhiyun }
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun /*
274*4882a593Smuzhiyun  * OPAL update flash
275*4882a593Smuzhiyun  */
opal_flash_update(int op)276*4882a593Smuzhiyun static int opal_flash_update(int op)
277*4882a593Smuzhiyun {
278*4882a593Smuzhiyun 	struct opal_sg_list *list;
279*4882a593Smuzhiyun 	unsigned long addr;
280*4882a593Smuzhiyun 	int64_t rc = OPAL_PARAMETER;
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun 	if (op == FLASH_UPDATE_CANCEL) {
283*4882a593Smuzhiyun 		pr_alert("FLASH: Image update cancelled\n");
284*4882a593Smuzhiyun 		addr = '\0';
285*4882a593Smuzhiyun 		goto flash;
286*4882a593Smuzhiyun 	}
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	list = opal_vmalloc_to_sg_list(image_data.data, image_data.size);
289*4882a593Smuzhiyun 	if (!list)
290*4882a593Smuzhiyun 		goto invalid_img;
291*4882a593Smuzhiyun 
292*4882a593Smuzhiyun 	/* First entry address */
293*4882a593Smuzhiyun 	addr = __pa(list);
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun flash:
296*4882a593Smuzhiyun 	rc = opal_update_flash(addr);
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun invalid_img:
299*4882a593Smuzhiyun 	return rc;
300*4882a593Smuzhiyun }
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun /* This gets called just before system reboots */
opal_flash_update_print_message(void)303*4882a593Smuzhiyun void opal_flash_update_print_message(void)
304*4882a593Smuzhiyun {
305*4882a593Smuzhiyun 	if (update_flash_data.status != FLASH_IMG_READY)
306*4882a593Smuzhiyun 		return;
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	pr_alert("FLASH: Flashing new firmware\n");
309*4882a593Smuzhiyun 	pr_alert("FLASH: Image is %u bytes\n", image_data.size);
310*4882a593Smuzhiyun 	pr_alert("FLASH: Performing flash and reboot/shutdown\n");
311*4882a593Smuzhiyun 	pr_alert("FLASH: This will take several minutes. Do not power off!\n");
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	/* Small delay to help getting the above message out */
314*4882a593Smuzhiyun 	msleep(500);
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun /*
318*4882a593Smuzhiyun  * Show candidate image status
319*4882a593Smuzhiyun  */
update_show(struct kobject * kobj,struct kobj_attribute * attr,char * buf)320*4882a593Smuzhiyun static ssize_t update_show(struct kobject *kobj,
321*4882a593Smuzhiyun 			   struct kobj_attribute *attr, char *buf)
322*4882a593Smuzhiyun {
323*4882a593Smuzhiyun 	struct update_flash_t *const args_buf = &update_flash_data;
324*4882a593Smuzhiyun 	return sprintf(buf, "%d\n", args_buf->status);
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun /*
328*4882a593Smuzhiyun  * Set update image flag
329*4882a593Smuzhiyun  *  1 - Flash new image
330*4882a593Smuzhiyun  *  0 - Cancel flash request
331*4882a593Smuzhiyun  */
update_store(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)332*4882a593Smuzhiyun static ssize_t update_store(struct kobject *kobj,
333*4882a593Smuzhiyun 			    struct kobj_attribute *attr,
334*4882a593Smuzhiyun 			    const char *buf, size_t count)
335*4882a593Smuzhiyun {
336*4882a593Smuzhiyun 	struct update_flash_t *const args_buf = &update_flash_data;
337*4882a593Smuzhiyun 	int rc = count;
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	mutex_lock(&image_data_mutex);
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	switch (buf[0]) {
342*4882a593Smuzhiyun 	case '0':
343*4882a593Smuzhiyun 		if (args_buf->status == FLASH_IMG_READY)
344*4882a593Smuzhiyun 			opal_flash_update(FLASH_UPDATE_CANCEL);
345*4882a593Smuzhiyun 		args_buf->status = FLASH_NO_OP;
346*4882a593Smuzhiyun 		break;
347*4882a593Smuzhiyun 	case '1':
348*4882a593Smuzhiyun 		/* Image is loaded? */
349*4882a593Smuzhiyun 		if (image_data.status == IMAGE_READY)
350*4882a593Smuzhiyun 			args_buf->status =
351*4882a593Smuzhiyun 				opal_flash_update(FLASH_UPDATE_INIT);
352*4882a593Smuzhiyun 		else
353*4882a593Smuzhiyun 			args_buf->status = FLASH_INVALID_IMG;
354*4882a593Smuzhiyun 		break;
355*4882a593Smuzhiyun 	default:
356*4882a593Smuzhiyun 		rc = -EINVAL;
357*4882a593Smuzhiyun 	}
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	mutex_unlock(&image_data_mutex);
360*4882a593Smuzhiyun 	return rc;
361*4882a593Smuzhiyun }
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun /*
364*4882a593Smuzhiyun  * Free image buffer
365*4882a593Smuzhiyun  */
free_image_buf(void)366*4882a593Smuzhiyun static void free_image_buf(void)
367*4882a593Smuzhiyun {
368*4882a593Smuzhiyun 	void *addr;
369*4882a593Smuzhiyun 	int size;
370*4882a593Smuzhiyun 
371*4882a593Smuzhiyun 	addr = image_data.data;
372*4882a593Smuzhiyun 	size = PAGE_ALIGN(image_data.size);
373*4882a593Smuzhiyun 	while (size > 0) {
374*4882a593Smuzhiyun 		ClearPageReserved(vmalloc_to_page(addr));
375*4882a593Smuzhiyun 		addr += PAGE_SIZE;
376*4882a593Smuzhiyun 		size -= PAGE_SIZE;
377*4882a593Smuzhiyun 	}
378*4882a593Smuzhiyun 	vfree(image_data.data);
379*4882a593Smuzhiyun 	image_data.data = NULL;
380*4882a593Smuzhiyun 	image_data.status = IMAGE_INVALID;
381*4882a593Smuzhiyun }
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun /*
384*4882a593Smuzhiyun  * Allocate image buffer.
385*4882a593Smuzhiyun  */
alloc_image_buf(char * buffer,size_t count)386*4882a593Smuzhiyun static int alloc_image_buf(char *buffer, size_t count)
387*4882a593Smuzhiyun {
388*4882a593Smuzhiyun 	void *addr;
389*4882a593Smuzhiyun 	int size;
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	if (count < sizeof(image_header)) {
392*4882a593Smuzhiyun 		pr_warn("FLASH: Invalid candidate image\n");
393*4882a593Smuzhiyun 		return -EINVAL;
394*4882a593Smuzhiyun 	}
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	memcpy(&image_header, (void *)buffer, sizeof(image_header));
397*4882a593Smuzhiyun 	image_data.size = be32_to_cpu(image_header.size);
398*4882a593Smuzhiyun 	pr_debug("FLASH: Candidate image size = %u\n", image_data.size);
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	if (image_data.size > MAX_IMAGE_SIZE) {
401*4882a593Smuzhiyun 		pr_warn("FLASH: Too large image\n");
402*4882a593Smuzhiyun 		return -EINVAL;
403*4882a593Smuzhiyun 	}
404*4882a593Smuzhiyun 	if (image_data.size < VALIDATE_BUF_SIZE) {
405*4882a593Smuzhiyun 		pr_warn("FLASH: Image is shorter than expected\n");
406*4882a593Smuzhiyun 		return -EINVAL;
407*4882a593Smuzhiyun 	}
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 	image_data.data = vzalloc(PAGE_ALIGN(image_data.size));
410*4882a593Smuzhiyun 	if (!image_data.data) {
411*4882a593Smuzhiyun 		pr_err("%s : Failed to allocate memory\n", __func__);
412*4882a593Smuzhiyun 		return -ENOMEM;
413*4882a593Smuzhiyun 	}
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 	/* Pin memory */
416*4882a593Smuzhiyun 	addr = image_data.data;
417*4882a593Smuzhiyun 	size = PAGE_ALIGN(image_data.size);
418*4882a593Smuzhiyun 	while (size > 0) {
419*4882a593Smuzhiyun 		SetPageReserved(vmalloc_to_page(addr));
420*4882a593Smuzhiyun 		addr += PAGE_SIZE;
421*4882a593Smuzhiyun 		size -= PAGE_SIZE;
422*4882a593Smuzhiyun 	}
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	image_data.status = IMAGE_LOADING;
425*4882a593Smuzhiyun 	return 0;
426*4882a593Smuzhiyun }
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun /*
429*4882a593Smuzhiyun  * Copy candidate image
430*4882a593Smuzhiyun  *
431*4882a593Smuzhiyun  * Parse candidate image header to get total image size
432*4882a593Smuzhiyun  * and pre-allocate required memory.
433*4882a593Smuzhiyun  */
image_data_write(struct file * filp,struct kobject * kobj,struct bin_attribute * bin_attr,char * buffer,loff_t pos,size_t count)434*4882a593Smuzhiyun static ssize_t image_data_write(struct file *filp, struct kobject *kobj,
435*4882a593Smuzhiyun 				struct bin_attribute *bin_attr,
436*4882a593Smuzhiyun 				char *buffer, loff_t pos, size_t count)
437*4882a593Smuzhiyun {
438*4882a593Smuzhiyun 	int rc;
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 	mutex_lock(&image_data_mutex);
441*4882a593Smuzhiyun 
442*4882a593Smuzhiyun 	/* New image ? */
443*4882a593Smuzhiyun 	if (pos == 0) {
444*4882a593Smuzhiyun 		/* Free memory, if already allocated */
445*4882a593Smuzhiyun 		if (image_data.data)
446*4882a593Smuzhiyun 			free_image_buf();
447*4882a593Smuzhiyun 
448*4882a593Smuzhiyun 		/* Cancel outstanding image update request */
449*4882a593Smuzhiyun 		if (update_flash_data.status == FLASH_IMG_READY)
450*4882a593Smuzhiyun 			opal_flash_update(FLASH_UPDATE_CANCEL);
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun 		/* Allocate memory */
453*4882a593Smuzhiyun 		rc = alloc_image_buf(buffer, count);
454*4882a593Smuzhiyun 		if (rc)
455*4882a593Smuzhiyun 			goto out;
456*4882a593Smuzhiyun 	}
457*4882a593Smuzhiyun 
458*4882a593Smuzhiyun 	if (image_data.status != IMAGE_LOADING) {
459*4882a593Smuzhiyun 		rc = -ENOMEM;
460*4882a593Smuzhiyun 		goto out;
461*4882a593Smuzhiyun 	}
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	if ((pos + count) > image_data.size) {
464*4882a593Smuzhiyun 		rc = -EINVAL;
465*4882a593Smuzhiyun 		goto out;
466*4882a593Smuzhiyun 	}
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	memcpy(image_data.data + pos, (void *)buffer, count);
469*4882a593Smuzhiyun 	rc = count;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	/* Set image status */
472*4882a593Smuzhiyun 	if ((pos + count) == image_data.size) {
473*4882a593Smuzhiyun 		pr_debug("FLASH: Candidate image loaded....\n");
474*4882a593Smuzhiyun 		image_data.status = IMAGE_READY;
475*4882a593Smuzhiyun 	}
476*4882a593Smuzhiyun 
477*4882a593Smuzhiyun out:
478*4882a593Smuzhiyun 	mutex_unlock(&image_data_mutex);
479*4882a593Smuzhiyun 	return rc;
480*4882a593Smuzhiyun }
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun /*
483*4882a593Smuzhiyun  * sysfs interface :
484*4882a593Smuzhiyun  *  OPAL uses below sysfs files for code update.
485*4882a593Smuzhiyun  *  We create these files under /sys/firmware/opal.
486*4882a593Smuzhiyun  *
487*4882a593Smuzhiyun  *   image		: Interface to load candidate firmware image
488*4882a593Smuzhiyun  *   validate_flash	: Validate firmware image
489*4882a593Smuzhiyun  *   manage_flash	: Commit/Reject firmware image
490*4882a593Smuzhiyun  *   update_flash	: Flash new firmware image
491*4882a593Smuzhiyun  *
492*4882a593Smuzhiyun  */
493*4882a593Smuzhiyun static const struct bin_attribute image_data_attr = {
494*4882a593Smuzhiyun 	.attr = {.name = "image", .mode = 0200},
495*4882a593Smuzhiyun 	.size = MAX_IMAGE_SIZE,	/* Limit image size */
496*4882a593Smuzhiyun 	.write = image_data_write,
497*4882a593Smuzhiyun };
498*4882a593Smuzhiyun 
499*4882a593Smuzhiyun static struct kobj_attribute validate_attribute =
500*4882a593Smuzhiyun 	__ATTR(validate_flash, 0600, validate_show, validate_store);
501*4882a593Smuzhiyun 
502*4882a593Smuzhiyun static struct kobj_attribute manage_attribute =
503*4882a593Smuzhiyun 	__ATTR(manage_flash, 0600, manage_show, manage_store);
504*4882a593Smuzhiyun 
505*4882a593Smuzhiyun static struct kobj_attribute update_attribute =
506*4882a593Smuzhiyun 	__ATTR(update_flash, 0600, update_show, update_store);
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun static struct attribute *image_op_attrs[] = {
509*4882a593Smuzhiyun 	&validate_attribute.attr,
510*4882a593Smuzhiyun 	&manage_attribute.attr,
511*4882a593Smuzhiyun 	&update_attribute.attr,
512*4882a593Smuzhiyun 	NULL	/* need to NULL terminate the list of attributes */
513*4882a593Smuzhiyun };
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun static struct attribute_group image_op_attr_group = {
516*4882a593Smuzhiyun 	.attrs = image_op_attrs,
517*4882a593Smuzhiyun };
518*4882a593Smuzhiyun 
opal_flash_update_init(void)519*4882a593Smuzhiyun void __init opal_flash_update_init(void)
520*4882a593Smuzhiyun {
521*4882a593Smuzhiyun 	int ret;
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun 	/* Allocate validate image buffer */
524*4882a593Smuzhiyun 	validate_flash_data.buf = kzalloc(VALIDATE_BUF_SIZE, GFP_KERNEL);
525*4882a593Smuzhiyun 	if (!validate_flash_data.buf) {
526*4882a593Smuzhiyun 		pr_err("%s : Failed to allocate memory\n", __func__);
527*4882a593Smuzhiyun 		return;
528*4882a593Smuzhiyun 	}
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun 	/* Make sure /sys/firmware/opal directory is created */
531*4882a593Smuzhiyun 	if (!opal_kobj) {
532*4882a593Smuzhiyun 		pr_warn("FLASH: opal kobject is not available\n");
533*4882a593Smuzhiyun 		goto nokobj;
534*4882a593Smuzhiyun 	}
535*4882a593Smuzhiyun 
536*4882a593Smuzhiyun 	/* Create the sysfs files */
537*4882a593Smuzhiyun 	ret = sysfs_create_group(opal_kobj, &image_op_attr_group);
538*4882a593Smuzhiyun 	if (ret) {
539*4882a593Smuzhiyun 		pr_warn("FLASH: Failed to create sysfs files\n");
540*4882a593Smuzhiyun 		goto nokobj;
541*4882a593Smuzhiyun 	}
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	ret = sysfs_create_bin_file(opal_kobj, &image_data_attr);
544*4882a593Smuzhiyun 	if (ret) {
545*4882a593Smuzhiyun 		pr_warn("FLASH: Failed to create sysfs files\n");
546*4882a593Smuzhiyun 		goto nosysfs_file;
547*4882a593Smuzhiyun 	}
548*4882a593Smuzhiyun 
549*4882a593Smuzhiyun 	/* Set default status */
550*4882a593Smuzhiyun 	validate_flash_data.status = FLASH_NO_OP;
551*4882a593Smuzhiyun 	manage_flash_data.status = FLASH_NO_OP;
552*4882a593Smuzhiyun 	update_flash_data.status = FLASH_NO_OP;
553*4882a593Smuzhiyun 	image_data.status = IMAGE_INVALID;
554*4882a593Smuzhiyun 	return;
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun nosysfs_file:
557*4882a593Smuzhiyun 	sysfs_remove_group(opal_kobj, &image_op_attr_group);
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun nokobj:
560*4882a593Smuzhiyun 	kfree(validate_flash_data.buf);
561*4882a593Smuzhiyun 	return;
562*4882a593Smuzhiyun }
563