xref: /OK3568_Linux_fs/kernel/arch/powerpc/platforms/ps3/os-area.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *  PS3 flash memory os area.
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  *  Copyright (C) 2006 Sony Computer Entertainment Inc.
6*4882a593Smuzhiyun  *  Copyright 2006 Sony Corp.
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/kernel.h>
10*4882a593Smuzhiyun #include <linux/io.h>
11*4882a593Smuzhiyun #include <linux/workqueue.h>
12*4882a593Smuzhiyun #include <linux/fs.h>
13*4882a593Smuzhiyun #include <linux/syscalls.h>
14*4882a593Smuzhiyun #include <linux/export.h>
15*4882a593Smuzhiyun #include <linux/ctype.h>
16*4882a593Smuzhiyun #include <linux/memblock.h>
17*4882a593Smuzhiyun #include <linux/of.h>
18*4882a593Smuzhiyun #include <linux/slab.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #include <asm/prom.h>
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #include "platform.h"
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun enum {
25*4882a593Smuzhiyun 	OS_AREA_SEGMENT_SIZE = 0X200,
26*4882a593Smuzhiyun };
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun enum os_area_ldr_format {
29*4882a593Smuzhiyun 	HEADER_LDR_FORMAT_RAW = 0,
30*4882a593Smuzhiyun 	HEADER_LDR_FORMAT_GZIP = 1,
31*4882a593Smuzhiyun };
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun #define OS_AREA_HEADER_MAGIC_NUM "cell_ext_os_area"
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun /**
36*4882a593Smuzhiyun  * struct os_area_header - os area header segment.
37*4882a593Smuzhiyun  * @magic_num: Always 'cell_ext_os_area'.
38*4882a593Smuzhiyun  * @hdr_version: Header format version number.
39*4882a593Smuzhiyun  * @db_area_offset: Starting segment number of other os database area.
40*4882a593Smuzhiyun  * @ldr_area_offset: Starting segment number of bootloader image area.
41*4882a593Smuzhiyun  * @ldr_format: HEADER_LDR_FORMAT flag.
42*4882a593Smuzhiyun  * @ldr_size: Size of bootloader image in bytes.
43*4882a593Smuzhiyun  *
44*4882a593Smuzhiyun  * Note that the docs refer to area offsets.  These are offsets in units of
45*4882a593Smuzhiyun  * segments from the start of the os area (top of the header).  These are
46*4882a593Smuzhiyun  * better thought of as segment numbers.  The os area of the os area is
47*4882a593Smuzhiyun  * reserved for the os image.
48*4882a593Smuzhiyun  */
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun struct os_area_header {
51*4882a593Smuzhiyun 	u8 magic_num[16];
52*4882a593Smuzhiyun 	u32 hdr_version;
53*4882a593Smuzhiyun 	u32 db_area_offset;
54*4882a593Smuzhiyun 	u32 ldr_area_offset;
55*4882a593Smuzhiyun 	u32 _reserved_1;
56*4882a593Smuzhiyun 	u32 ldr_format;
57*4882a593Smuzhiyun 	u32 ldr_size;
58*4882a593Smuzhiyun 	u32 _reserved_2[6];
59*4882a593Smuzhiyun };
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun enum os_area_boot_flag {
62*4882a593Smuzhiyun 	PARAM_BOOT_FLAG_GAME_OS = 0,
63*4882a593Smuzhiyun 	PARAM_BOOT_FLAG_OTHER_OS = 1,
64*4882a593Smuzhiyun };
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun enum os_area_ctrl_button {
67*4882a593Smuzhiyun 	PARAM_CTRL_BUTTON_O_IS_YES = 0,
68*4882a593Smuzhiyun 	PARAM_CTRL_BUTTON_X_IS_YES = 1,
69*4882a593Smuzhiyun };
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun /**
72*4882a593Smuzhiyun  * struct os_area_params - os area params segment.
73*4882a593Smuzhiyun  * @boot_flag: User preference of operating system, PARAM_BOOT_FLAG flag.
74*4882a593Smuzhiyun  * @num_params: Number of params in this (params) segment.
75*4882a593Smuzhiyun  * @rtc_diff: Difference in seconds between 1970 and the ps3 rtc value.
76*4882a593Smuzhiyun  * @av_multi_out: User preference of AV output, PARAM_AV_MULTI_OUT flag.
77*4882a593Smuzhiyun  * @ctrl_button: User preference of controller button config, PARAM_CTRL_BUTTON
78*4882a593Smuzhiyun  *	flag.
79*4882a593Smuzhiyun  * @static_ip_addr: User preference of static IP address.
80*4882a593Smuzhiyun  * @network_mask: User preference of static network mask.
81*4882a593Smuzhiyun  * @default_gateway: User preference of static default gateway.
82*4882a593Smuzhiyun  * @dns_primary: User preference of static primary dns server.
83*4882a593Smuzhiyun  * @dns_secondary: User preference of static secondary dns server.
84*4882a593Smuzhiyun  *
85*4882a593Smuzhiyun  * The ps3 rtc maintains a read-only value that approximates seconds since
86*4882a593Smuzhiyun  * 2000-01-01 00:00:00 UTC.
87*4882a593Smuzhiyun  *
88*4882a593Smuzhiyun  * User preference of zero for static_ip_addr means use dhcp.
89*4882a593Smuzhiyun  */
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun struct os_area_params {
92*4882a593Smuzhiyun 	u32 boot_flag;
93*4882a593Smuzhiyun 	u32 _reserved_1[3];
94*4882a593Smuzhiyun 	u32 num_params;
95*4882a593Smuzhiyun 	u32 _reserved_2[3];
96*4882a593Smuzhiyun 	/* param 0 */
97*4882a593Smuzhiyun 	s64 rtc_diff;
98*4882a593Smuzhiyun 	u8 av_multi_out;
99*4882a593Smuzhiyun 	u8 ctrl_button;
100*4882a593Smuzhiyun 	u8 _reserved_3[6];
101*4882a593Smuzhiyun 	/* param 1 */
102*4882a593Smuzhiyun 	u8 static_ip_addr[4];
103*4882a593Smuzhiyun 	u8 network_mask[4];
104*4882a593Smuzhiyun 	u8 default_gateway[4];
105*4882a593Smuzhiyun 	u8 _reserved_4[4];
106*4882a593Smuzhiyun 	/* param 2 */
107*4882a593Smuzhiyun 	u8 dns_primary[4];
108*4882a593Smuzhiyun 	u8 dns_secondary[4];
109*4882a593Smuzhiyun 	u8 _reserved_5[8];
110*4882a593Smuzhiyun };
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun #define OS_AREA_DB_MAGIC_NUM "-db-"
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun /**
115*4882a593Smuzhiyun  * struct os_area_db - Shared flash memory database.
116*4882a593Smuzhiyun  * @magic_num: Always '-db-'.
117*4882a593Smuzhiyun  * @version: os_area_db format version number.
118*4882a593Smuzhiyun  * @index_64: byte offset of the database id index for 64 bit variables.
119*4882a593Smuzhiyun  * @count_64: number of usable 64 bit index entries
120*4882a593Smuzhiyun  * @index_32: byte offset of the database id index for 32 bit variables.
121*4882a593Smuzhiyun  * @count_32: number of usable 32 bit index entries
122*4882a593Smuzhiyun  * @index_16: byte offset of the database id index for 16 bit variables.
123*4882a593Smuzhiyun  * @count_16: number of usable 16 bit index entries
124*4882a593Smuzhiyun  *
125*4882a593Smuzhiyun  * Flash rom storage for exclusive use by guests running in the other os lpar.
126*4882a593Smuzhiyun  * The current system configuration allocates 1K (two segments) for other os
127*4882a593Smuzhiyun  * use.
128*4882a593Smuzhiyun  */
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun struct os_area_db {
131*4882a593Smuzhiyun 	u8 magic_num[4];
132*4882a593Smuzhiyun 	u16 version;
133*4882a593Smuzhiyun 	u16 _reserved_1;
134*4882a593Smuzhiyun 	u16 index_64;
135*4882a593Smuzhiyun 	u16 count_64;
136*4882a593Smuzhiyun 	u16 index_32;
137*4882a593Smuzhiyun 	u16 count_32;
138*4882a593Smuzhiyun 	u16 index_16;
139*4882a593Smuzhiyun 	u16 count_16;
140*4882a593Smuzhiyun 	u32 _reserved_2;
141*4882a593Smuzhiyun 	u8 _db_data[1000];
142*4882a593Smuzhiyun };
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun /**
145*4882a593Smuzhiyun  * enum os_area_db_owner - Data owners.
146*4882a593Smuzhiyun  */
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun enum os_area_db_owner {
149*4882a593Smuzhiyun 	OS_AREA_DB_OWNER_ANY = -1,
150*4882a593Smuzhiyun 	OS_AREA_DB_OWNER_NONE = 0,
151*4882a593Smuzhiyun 	OS_AREA_DB_OWNER_PROTOTYPE = 1,
152*4882a593Smuzhiyun 	OS_AREA_DB_OWNER_LINUX = 2,
153*4882a593Smuzhiyun 	OS_AREA_DB_OWNER_PETITBOOT = 3,
154*4882a593Smuzhiyun 	OS_AREA_DB_OWNER_MAX = 32,
155*4882a593Smuzhiyun };
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun enum os_area_db_key {
158*4882a593Smuzhiyun 	OS_AREA_DB_KEY_ANY = -1,
159*4882a593Smuzhiyun 	OS_AREA_DB_KEY_NONE = 0,
160*4882a593Smuzhiyun 	OS_AREA_DB_KEY_RTC_DIFF = 1,
161*4882a593Smuzhiyun 	OS_AREA_DB_KEY_VIDEO_MODE = 2,
162*4882a593Smuzhiyun 	OS_AREA_DB_KEY_MAX = 8,
163*4882a593Smuzhiyun };
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun struct os_area_db_id {
166*4882a593Smuzhiyun 	int owner;
167*4882a593Smuzhiyun 	int key;
168*4882a593Smuzhiyun };
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun static const struct os_area_db_id os_area_db_id_empty = {
171*4882a593Smuzhiyun 	.owner = OS_AREA_DB_OWNER_NONE,
172*4882a593Smuzhiyun 	.key = OS_AREA_DB_KEY_NONE
173*4882a593Smuzhiyun };
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun static const struct os_area_db_id os_area_db_id_any = {
176*4882a593Smuzhiyun 	.owner = OS_AREA_DB_OWNER_ANY,
177*4882a593Smuzhiyun 	.key = OS_AREA_DB_KEY_ANY
178*4882a593Smuzhiyun };
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun static const struct os_area_db_id os_area_db_id_rtc_diff = {
181*4882a593Smuzhiyun 	.owner = OS_AREA_DB_OWNER_LINUX,
182*4882a593Smuzhiyun 	.key = OS_AREA_DB_KEY_RTC_DIFF
183*4882a593Smuzhiyun };
184*4882a593Smuzhiyun 
185*4882a593Smuzhiyun #define SECONDS_FROM_1970_TO_2000 946684800LL
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun /**
188*4882a593Smuzhiyun  * struct saved_params - Static working copies of data from the PS3 'os area'.
189*4882a593Smuzhiyun  *
190*4882a593Smuzhiyun  * The order of preference we use for the rtc_diff source:
191*4882a593Smuzhiyun  *  1) The database value.
192*4882a593Smuzhiyun  *  2) The game os value.
193*4882a593Smuzhiyun  *  3) The number of seconds from 1970 to 2000.
194*4882a593Smuzhiyun  */
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun static struct saved_params {
197*4882a593Smuzhiyun 	unsigned int valid;
198*4882a593Smuzhiyun 	s64 rtc_diff;
199*4882a593Smuzhiyun 	unsigned int av_multi_out;
200*4882a593Smuzhiyun } saved_params;
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun static struct property property_rtc_diff = {
203*4882a593Smuzhiyun 	.name = "linux,rtc_diff",
204*4882a593Smuzhiyun 	.length = sizeof(saved_params.rtc_diff),
205*4882a593Smuzhiyun 	.value = &saved_params.rtc_diff,
206*4882a593Smuzhiyun };
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun static struct property property_av_multi_out = {
209*4882a593Smuzhiyun 	.name = "linux,av_multi_out",
210*4882a593Smuzhiyun 	.length = sizeof(saved_params.av_multi_out),
211*4882a593Smuzhiyun 	.value = &saved_params.av_multi_out,
212*4882a593Smuzhiyun };
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun static DEFINE_MUTEX(os_area_flash_mutex);
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun static const struct ps3_os_area_flash_ops *os_area_flash_ops;
218*4882a593Smuzhiyun 
ps3_os_area_flash_register(const struct ps3_os_area_flash_ops * ops)219*4882a593Smuzhiyun void ps3_os_area_flash_register(const struct ps3_os_area_flash_ops *ops)
220*4882a593Smuzhiyun {
221*4882a593Smuzhiyun 	mutex_lock(&os_area_flash_mutex);
222*4882a593Smuzhiyun 	os_area_flash_ops = ops;
223*4882a593Smuzhiyun 	mutex_unlock(&os_area_flash_mutex);
224*4882a593Smuzhiyun }
225*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(ps3_os_area_flash_register);
226*4882a593Smuzhiyun 
os_area_flash_read(void * buf,size_t count,loff_t pos)227*4882a593Smuzhiyun static ssize_t os_area_flash_read(void *buf, size_t count, loff_t pos)
228*4882a593Smuzhiyun {
229*4882a593Smuzhiyun 	ssize_t res = -ENODEV;
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun 	mutex_lock(&os_area_flash_mutex);
232*4882a593Smuzhiyun 	if (os_area_flash_ops)
233*4882a593Smuzhiyun 		res = os_area_flash_ops->read(buf, count, pos);
234*4882a593Smuzhiyun 	mutex_unlock(&os_area_flash_mutex);
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	return res;
237*4882a593Smuzhiyun }
238*4882a593Smuzhiyun 
os_area_flash_write(const void * buf,size_t count,loff_t pos)239*4882a593Smuzhiyun static ssize_t os_area_flash_write(const void *buf, size_t count, loff_t pos)
240*4882a593Smuzhiyun {
241*4882a593Smuzhiyun 	ssize_t res = -ENODEV;
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	mutex_lock(&os_area_flash_mutex);
244*4882a593Smuzhiyun 	if (os_area_flash_ops)
245*4882a593Smuzhiyun 		res = os_area_flash_ops->write(buf, count, pos);
246*4882a593Smuzhiyun 	mutex_unlock(&os_area_flash_mutex);
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	return res;
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun /**
253*4882a593Smuzhiyun  * os_area_set_property - Add or overwrite a saved_params value to the device tree.
254*4882a593Smuzhiyun  *
255*4882a593Smuzhiyun  * Overwrites an existing property.
256*4882a593Smuzhiyun  */
257*4882a593Smuzhiyun 
os_area_set_property(struct device_node * node,struct property * prop)258*4882a593Smuzhiyun static void os_area_set_property(struct device_node *node,
259*4882a593Smuzhiyun 	struct property *prop)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun 	int result;
262*4882a593Smuzhiyun 	struct property *tmp = of_find_property(node, prop->name, NULL);
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	if (tmp) {
265*4882a593Smuzhiyun 		pr_debug("%s:%d found %s\n", __func__, __LINE__, prop->name);
266*4882a593Smuzhiyun 		of_remove_property(node, tmp);
267*4882a593Smuzhiyun 	}
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	result = of_add_property(node, prop);
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	if (result)
272*4882a593Smuzhiyun 		pr_debug("%s:%d of_set_property failed\n", __func__,
273*4882a593Smuzhiyun 			__LINE__);
274*4882a593Smuzhiyun }
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun /**
277*4882a593Smuzhiyun  * os_area_get_property - Get a saved_params value from the device tree.
278*4882a593Smuzhiyun  *
279*4882a593Smuzhiyun  */
280*4882a593Smuzhiyun 
os_area_get_property(struct device_node * node,struct property * prop)281*4882a593Smuzhiyun static void __init os_area_get_property(struct device_node *node,
282*4882a593Smuzhiyun 	struct property *prop)
283*4882a593Smuzhiyun {
284*4882a593Smuzhiyun 	const struct property *tmp = of_find_property(node, prop->name, NULL);
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	if (tmp) {
287*4882a593Smuzhiyun 		BUG_ON(prop->length != tmp->length);
288*4882a593Smuzhiyun 		memcpy(prop->value, tmp->value, prop->length);
289*4882a593Smuzhiyun 	} else
290*4882a593Smuzhiyun 		pr_debug("%s:%d not found %s\n", __func__, __LINE__,
291*4882a593Smuzhiyun 			prop->name);
292*4882a593Smuzhiyun }
293*4882a593Smuzhiyun 
dump_field(char * s,const u8 * field,int size_of_field)294*4882a593Smuzhiyun static void dump_field(char *s, const u8 *field, int size_of_field)
295*4882a593Smuzhiyun {
296*4882a593Smuzhiyun #if defined(DEBUG)
297*4882a593Smuzhiyun 	int i;
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	for (i = 0; i < size_of_field; i++)
300*4882a593Smuzhiyun 		s[i] = isprint(field[i]) ? field[i] : '.';
301*4882a593Smuzhiyun 	s[i] = 0;
302*4882a593Smuzhiyun #endif
303*4882a593Smuzhiyun }
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun #define dump_header(_a) _dump_header(_a, __func__, __LINE__)
_dump_header(const struct os_area_header * h,const char * func,int line)306*4882a593Smuzhiyun static void _dump_header(const struct os_area_header *h, const char *func,
307*4882a593Smuzhiyun 	int line)
308*4882a593Smuzhiyun {
309*4882a593Smuzhiyun 	char str[sizeof(h->magic_num) + 1];
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	dump_field(str, h->magic_num, sizeof(h->magic_num));
312*4882a593Smuzhiyun 	pr_debug("%s:%d: h.magic_num:       '%s'\n", func, line,
313*4882a593Smuzhiyun 		str);
314*4882a593Smuzhiyun 	pr_debug("%s:%d: h.hdr_version:     %u\n", func, line,
315*4882a593Smuzhiyun 		h->hdr_version);
316*4882a593Smuzhiyun 	pr_debug("%s:%d: h.db_area_offset:  %u\n", func, line,
317*4882a593Smuzhiyun 		h->db_area_offset);
318*4882a593Smuzhiyun 	pr_debug("%s:%d: h.ldr_area_offset: %u\n", func, line,
319*4882a593Smuzhiyun 		h->ldr_area_offset);
320*4882a593Smuzhiyun 	pr_debug("%s:%d: h.ldr_format:      %u\n", func, line,
321*4882a593Smuzhiyun 		h->ldr_format);
322*4882a593Smuzhiyun 	pr_debug("%s:%d: h.ldr_size:        %xh\n", func, line,
323*4882a593Smuzhiyun 		h->ldr_size);
324*4882a593Smuzhiyun }
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun #define dump_params(_a) _dump_params(_a, __func__, __LINE__)
_dump_params(const struct os_area_params * p,const char * func,int line)327*4882a593Smuzhiyun static void _dump_params(const struct os_area_params *p, const char *func,
328*4882a593Smuzhiyun 	int line)
329*4882a593Smuzhiyun {
330*4882a593Smuzhiyun 	pr_debug("%s:%d: p.boot_flag:       %u\n", func, line, p->boot_flag);
331*4882a593Smuzhiyun 	pr_debug("%s:%d: p.num_params:      %u\n", func, line, p->num_params);
332*4882a593Smuzhiyun 	pr_debug("%s:%d: p.rtc_diff         %lld\n", func, line, p->rtc_diff);
333*4882a593Smuzhiyun 	pr_debug("%s:%d: p.av_multi_out     %u\n", func, line, p->av_multi_out);
334*4882a593Smuzhiyun 	pr_debug("%s:%d: p.ctrl_button:     %u\n", func, line, p->ctrl_button);
335*4882a593Smuzhiyun 	pr_debug("%s:%d: p.static_ip_addr:  %u.%u.%u.%u\n", func, line,
336*4882a593Smuzhiyun 		p->static_ip_addr[0], p->static_ip_addr[1],
337*4882a593Smuzhiyun 		p->static_ip_addr[2], p->static_ip_addr[3]);
338*4882a593Smuzhiyun 	pr_debug("%s:%d: p.network_mask:    %u.%u.%u.%u\n", func, line,
339*4882a593Smuzhiyun 		p->network_mask[0], p->network_mask[1],
340*4882a593Smuzhiyun 		p->network_mask[2], p->network_mask[3]);
341*4882a593Smuzhiyun 	pr_debug("%s:%d: p.default_gateway: %u.%u.%u.%u\n", func, line,
342*4882a593Smuzhiyun 		p->default_gateway[0], p->default_gateway[1],
343*4882a593Smuzhiyun 		p->default_gateway[2], p->default_gateway[3]);
344*4882a593Smuzhiyun 	pr_debug("%s:%d: p.dns_primary:     %u.%u.%u.%u\n", func, line,
345*4882a593Smuzhiyun 		p->dns_primary[0], p->dns_primary[1],
346*4882a593Smuzhiyun 		p->dns_primary[2], p->dns_primary[3]);
347*4882a593Smuzhiyun 	pr_debug("%s:%d: p.dns_secondary:   %u.%u.%u.%u\n", func, line,
348*4882a593Smuzhiyun 		p->dns_secondary[0], p->dns_secondary[1],
349*4882a593Smuzhiyun 		p->dns_secondary[2], p->dns_secondary[3]);
350*4882a593Smuzhiyun }
351*4882a593Smuzhiyun 
verify_header(const struct os_area_header * header)352*4882a593Smuzhiyun static int verify_header(const struct os_area_header *header)
353*4882a593Smuzhiyun {
354*4882a593Smuzhiyun 	if (memcmp(header->magic_num, OS_AREA_HEADER_MAGIC_NUM,
355*4882a593Smuzhiyun 		sizeof(header->magic_num))) {
356*4882a593Smuzhiyun 		pr_debug("%s:%d magic_num failed\n", __func__, __LINE__);
357*4882a593Smuzhiyun 		return -1;
358*4882a593Smuzhiyun 	}
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 	if (header->hdr_version < 1) {
361*4882a593Smuzhiyun 		pr_debug("%s:%d hdr_version failed\n", __func__, __LINE__);
362*4882a593Smuzhiyun 		return -1;
363*4882a593Smuzhiyun 	}
364*4882a593Smuzhiyun 
365*4882a593Smuzhiyun 	if (header->db_area_offset > header->ldr_area_offset) {
366*4882a593Smuzhiyun 		pr_debug("%s:%d offsets failed\n", __func__, __LINE__);
367*4882a593Smuzhiyun 		return -1;
368*4882a593Smuzhiyun 	}
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	return 0;
371*4882a593Smuzhiyun }
372*4882a593Smuzhiyun 
db_verify(const struct os_area_db * db)373*4882a593Smuzhiyun static int db_verify(const struct os_area_db *db)
374*4882a593Smuzhiyun {
375*4882a593Smuzhiyun 	if (memcmp(db->magic_num, OS_AREA_DB_MAGIC_NUM,
376*4882a593Smuzhiyun 		sizeof(db->magic_num))) {
377*4882a593Smuzhiyun 		pr_debug("%s:%d magic_num failed\n", __func__, __LINE__);
378*4882a593Smuzhiyun 		return -EINVAL;
379*4882a593Smuzhiyun 	}
380*4882a593Smuzhiyun 
381*4882a593Smuzhiyun 	if (db->version != 1) {
382*4882a593Smuzhiyun 		pr_debug("%s:%d version failed\n", __func__, __LINE__);
383*4882a593Smuzhiyun 		return -EINVAL;
384*4882a593Smuzhiyun 	}
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	return 0;
387*4882a593Smuzhiyun }
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun struct db_index {
390*4882a593Smuzhiyun        uint8_t owner:5;
391*4882a593Smuzhiyun        uint8_t key:3;
392*4882a593Smuzhiyun };
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun struct db_iterator {
395*4882a593Smuzhiyun 	const struct os_area_db *db;
396*4882a593Smuzhiyun 	struct os_area_db_id match_id;
397*4882a593Smuzhiyun 	struct db_index *idx;
398*4882a593Smuzhiyun 	struct db_index *last_idx;
399*4882a593Smuzhiyun 	union {
400*4882a593Smuzhiyun 		uint64_t *value_64;
401*4882a593Smuzhiyun 		uint32_t *value_32;
402*4882a593Smuzhiyun 		uint16_t *value_16;
403*4882a593Smuzhiyun 	};
404*4882a593Smuzhiyun };
405*4882a593Smuzhiyun 
db_align_up(unsigned int val,unsigned int size)406*4882a593Smuzhiyun static unsigned int db_align_up(unsigned int val, unsigned int size)
407*4882a593Smuzhiyun {
408*4882a593Smuzhiyun 	return (val + (size - 1)) & (~(size - 1));
409*4882a593Smuzhiyun }
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun /**
412*4882a593Smuzhiyun  * db_for_each_64 - Iterator for 64 bit entries.
413*4882a593Smuzhiyun  *
414*4882a593Smuzhiyun  * A NULL value for id can be used to match all entries.
415*4882a593Smuzhiyun  * OS_AREA_DB_OWNER_ANY and OS_AREA_DB_KEY_ANY can be used to match all.
416*4882a593Smuzhiyun  */
417*4882a593Smuzhiyun 
db_for_each_64(const struct os_area_db * db,const struct os_area_db_id * match_id,struct db_iterator * i)418*4882a593Smuzhiyun static int db_for_each_64(const struct os_area_db *db,
419*4882a593Smuzhiyun 	const struct os_area_db_id *match_id, struct db_iterator *i)
420*4882a593Smuzhiyun {
421*4882a593Smuzhiyun next:
422*4882a593Smuzhiyun 	if (!i->db) {
423*4882a593Smuzhiyun 		i->db = db;
424*4882a593Smuzhiyun 		i->match_id = match_id ? *match_id : os_area_db_id_any;
425*4882a593Smuzhiyun 		i->idx = (void *)db + db->index_64;
426*4882a593Smuzhiyun 		i->last_idx = i->idx + db->count_64;
427*4882a593Smuzhiyun 		i->value_64 = (void *)db + db->index_64
428*4882a593Smuzhiyun 			+ db_align_up(db->count_64, 8);
429*4882a593Smuzhiyun 	} else {
430*4882a593Smuzhiyun 		i->idx++;
431*4882a593Smuzhiyun 		i->value_64++;
432*4882a593Smuzhiyun 	}
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 	if (i->idx >= i->last_idx) {
435*4882a593Smuzhiyun 		pr_debug("%s:%d: reached end\n", __func__, __LINE__);
436*4882a593Smuzhiyun 		return 0;
437*4882a593Smuzhiyun 	}
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun 	if (i->match_id.owner != OS_AREA_DB_OWNER_ANY
440*4882a593Smuzhiyun 		&& i->match_id.owner != (int)i->idx->owner)
441*4882a593Smuzhiyun 		goto next;
442*4882a593Smuzhiyun 	if (i->match_id.key != OS_AREA_DB_KEY_ANY
443*4882a593Smuzhiyun 		&& i->match_id.key != (int)i->idx->key)
444*4882a593Smuzhiyun 		goto next;
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun 	return 1;
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun 
db_delete_64(struct os_area_db * db,const struct os_area_db_id * id)449*4882a593Smuzhiyun static int db_delete_64(struct os_area_db *db, const struct os_area_db_id *id)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun 	struct db_iterator i;
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	for (i.db = NULL; db_for_each_64(db, id, &i); ) {
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 		pr_debug("%s:%d: got (%d:%d) %llxh\n", __func__, __LINE__,
456*4882a593Smuzhiyun 			i.idx->owner, i.idx->key,
457*4882a593Smuzhiyun 			(unsigned long long)*i.value_64);
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun 		i.idx->owner = 0;
460*4882a593Smuzhiyun 		i.idx->key = 0;
461*4882a593Smuzhiyun 		*i.value_64 = 0;
462*4882a593Smuzhiyun 	}
463*4882a593Smuzhiyun 	return 0;
464*4882a593Smuzhiyun }
465*4882a593Smuzhiyun 
db_set_64(struct os_area_db * db,const struct os_area_db_id * id,uint64_t value)466*4882a593Smuzhiyun static int db_set_64(struct os_area_db *db, const struct os_area_db_id *id,
467*4882a593Smuzhiyun 	uint64_t value)
468*4882a593Smuzhiyun {
469*4882a593Smuzhiyun 	struct db_iterator i;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	pr_debug("%s:%d: (%d:%d) <= %llxh\n", __func__, __LINE__,
472*4882a593Smuzhiyun 		id->owner, id->key, (unsigned long long)value);
473*4882a593Smuzhiyun 
474*4882a593Smuzhiyun 	if (!id->owner || id->owner == OS_AREA_DB_OWNER_ANY
475*4882a593Smuzhiyun 		|| id->key == OS_AREA_DB_KEY_ANY) {
476*4882a593Smuzhiyun 		pr_debug("%s:%d: bad id: (%d:%d)\n", __func__,
477*4882a593Smuzhiyun 			__LINE__, id->owner, id->key);
478*4882a593Smuzhiyun 		return -1;
479*4882a593Smuzhiyun 	}
480*4882a593Smuzhiyun 
481*4882a593Smuzhiyun 	db_delete_64(db, id);
482*4882a593Smuzhiyun 
483*4882a593Smuzhiyun 	i.db = NULL;
484*4882a593Smuzhiyun 	if (db_for_each_64(db, &os_area_db_id_empty, &i)) {
485*4882a593Smuzhiyun 
486*4882a593Smuzhiyun 		pr_debug("%s:%d: got (%d:%d) %llxh\n", __func__, __LINE__,
487*4882a593Smuzhiyun 			i.idx->owner, i.idx->key,
488*4882a593Smuzhiyun 			(unsigned long long)*i.value_64);
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 		i.idx->owner = id->owner;
491*4882a593Smuzhiyun 		i.idx->key = id->key;
492*4882a593Smuzhiyun 		*i.value_64 = value;
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun 		pr_debug("%s:%d: set (%d:%d) <= %llxh\n", __func__, __LINE__,
495*4882a593Smuzhiyun 			i.idx->owner, i.idx->key,
496*4882a593Smuzhiyun 			(unsigned long long)*i.value_64);
497*4882a593Smuzhiyun 		return 0;
498*4882a593Smuzhiyun 	}
499*4882a593Smuzhiyun 	pr_debug("%s:%d: database full.\n",
500*4882a593Smuzhiyun 		__func__, __LINE__);
501*4882a593Smuzhiyun 	return -1;
502*4882a593Smuzhiyun }
503*4882a593Smuzhiyun 
db_get_64(const struct os_area_db * db,const struct os_area_db_id * id,uint64_t * value)504*4882a593Smuzhiyun static int db_get_64(const struct os_area_db *db,
505*4882a593Smuzhiyun 	const struct os_area_db_id *id, uint64_t *value)
506*4882a593Smuzhiyun {
507*4882a593Smuzhiyun 	struct db_iterator i;
508*4882a593Smuzhiyun 
509*4882a593Smuzhiyun 	i.db = NULL;
510*4882a593Smuzhiyun 	if (db_for_each_64(db, id, &i)) {
511*4882a593Smuzhiyun 		*value = *i.value_64;
512*4882a593Smuzhiyun 		pr_debug("%s:%d: found %lld\n", __func__, __LINE__,
513*4882a593Smuzhiyun 				(long long int)*i.value_64);
514*4882a593Smuzhiyun 		return 0;
515*4882a593Smuzhiyun 	}
516*4882a593Smuzhiyun 	pr_debug("%s:%d: not found\n", __func__, __LINE__);
517*4882a593Smuzhiyun 	return -1;
518*4882a593Smuzhiyun }
519*4882a593Smuzhiyun 
db_get_rtc_diff(const struct os_area_db * db,int64_t * rtc_diff)520*4882a593Smuzhiyun static int db_get_rtc_diff(const struct os_area_db *db, int64_t *rtc_diff)
521*4882a593Smuzhiyun {
522*4882a593Smuzhiyun 	return db_get_64(db, &os_area_db_id_rtc_diff, (uint64_t*)rtc_diff);
523*4882a593Smuzhiyun }
524*4882a593Smuzhiyun 
525*4882a593Smuzhiyun #define dump_db(a) _dump_db(a, __func__, __LINE__)
_dump_db(const struct os_area_db * db,const char * func,int line)526*4882a593Smuzhiyun static void _dump_db(const struct os_area_db *db, const char *func,
527*4882a593Smuzhiyun 	int line)
528*4882a593Smuzhiyun {
529*4882a593Smuzhiyun 	char str[sizeof(db->magic_num) + 1];
530*4882a593Smuzhiyun 
531*4882a593Smuzhiyun 	dump_field(str, db->magic_num, sizeof(db->magic_num));
532*4882a593Smuzhiyun 	pr_debug("%s:%d: db.magic_num:      '%s'\n", func, line,
533*4882a593Smuzhiyun 		str);
534*4882a593Smuzhiyun 	pr_debug("%s:%d: db.version:         %u\n", func, line,
535*4882a593Smuzhiyun 		db->version);
536*4882a593Smuzhiyun 	pr_debug("%s:%d: db.index_64:        %u\n", func, line,
537*4882a593Smuzhiyun 		db->index_64);
538*4882a593Smuzhiyun 	pr_debug("%s:%d: db.count_64:        %u\n", func, line,
539*4882a593Smuzhiyun 		db->count_64);
540*4882a593Smuzhiyun 	pr_debug("%s:%d: db.index_32:        %u\n", func, line,
541*4882a593Smuzhiyun 		db->index_32);
542*4882a593Smuzhiyun 	pr_debug("%s:%d: db.count_32:        %u\n", func, line,
543*4882a593Smuzhiyun 		db->count_32);
544*4882a593Smuzhiyun 	pr_debug("%s:%d: db.index_16:        %u\n", func, line,
545*4882a593Smuzhiyun 		db->index_16);
546*4882a593Smuzhiyun 	pr_debug("%s:%d: db.count_16:        %u\n", func, line,
547*4882a593Smuzhiyun 		db->count_16);
548*4882a593Smuzhiyun }
549*4882a593Smuzhiyun 
os_area_db_init(struct os_area_db * db)550*4882a593Smuzhiyun static void os_area_db_init(struct os_area_db *db)
551*4882a593Smuzhiyun {
552*4882a593Smuzhiyun 	enum {
553*4882a593Smuzhiyun 		HEADER_SIZE = offsetof(struct os_area_db, _db_data),
554*4882a593Smuzhiyun 		INDEX_64_COUNT = 64,
555*4882a593Smuzhiyun 		VALUES_64_COUNT = 57,
556*4882a593Smuzhiyun 		INDEX_32_COUNT = 64,
557*4882a593Smuzhiyun 		VALUES_32_COUNT = 57,
558*4882a593Smuzhiyun 		INDEX_16_COUNT = 64,
559*4882a593Smuzhiyun 		VALUES_16_COUNT = 57,
560*4882a593Smuzhiyun 	};
561*4882a593Smuzhiyun 
562*4882a593Smuzhiyun 	memset(db, 0, sizeof(struct os_area_db));
563*4882a593Smuzhiyun 
564*4882a593Smuzhiyun 	memcpy(db->magic_num, OS_AREA_DB_MAGIC_NUM, sizeof(db->magic_num));
565*4882a593Smuzhiyun 	db->version = 1;
566*4882a593Smuzhiyun 	db->index_64 = HEADER_SIZE;
567*4882a593Smuzhiyun 	db->count_64 = VALUES_64_COUNT;
568*4882a593Smuzhiyun 	db->index_32 = HEADER_SIZE
569*4882a593Smuzhiyun 			+ INDEX_64_COUNT * sizeof(struct db_index)
570*4882a593Smuzhiyun 			+ VALUES_64_COUNT * sizeof(u64);
571*4882a593Smuzhiyun 	db->count_32 = VALUES_32_COUNT;
572*4882a593Smuzhiyun 	db->index_16 = HEADER_SIZE
573*4882a593Smuzhiyun 			+ INDEX_64_COUNT * sizeof(struct db_index)
574*4882a593Smuzhiyun 			+ VALUES_64_COUNT * sizeof(u64)
575*4882a593Smuzhiyun 			+ INDEX_32_COUNT * sizeof(struct db_index)
576*4882a593Smuzhiyun 			+ VALUES_32_COUNT * sizeof(u32);
577*4882a593Smuzhiyun 	db->count_16 = VALUES_16_COUNT;
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	/* Rules to check db layout. */
580*4882a593Smuzhiyun 
581*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct db_index) != 1);
582*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct os_area_db) != 2 * OS_AREA_SEGMENT_SIZE);
583*4882a593Smuzhiyun 	BUILD_BUG_ON(INDEX_64_COUNT & 0x7);
584*4882a593Smuzhiyun 	BUILD_BUG_ON(VALUES_64_COUNT > INDEX_64_COUNT);
585*4882a593Smuzhiyun 	BUILD_BUG_ON(INDEX_32_COUNT & 0x7);
586*4882a593Smuzhiyun 	BUILD_BUG_ON(VALUES_32_COUNT > INDEX_32_COUNT);
587*4882a593Smuzhiyun 	BUILD_BUG_ON(INDEX_16_COUNT & 0x7);
588*4882a593Smuzhiyun 	BUILD_BUG_ON(VALUES_16_COUNT > INDEX_16_COUNT);
589*4882a593Smuzhiyun 	BUILD_BUG_ON(HEADER_SIZE
590*4882a593Smuzhiyun 			+ INDEX_64_COUNT * sizeof(struct db_index)
591*4882a593Smuzhiyun 			+ VALUES_64_COUNT * sizeof(u64)
592*4882a593Smuzhiyun 			+ INDEX_32_COUNT * sizeof(struct db_index)
593*4882a593Smuzhiyun 			+ VALUES_32_COUNT * sizeof(u32)
594*4882a593Smuzhiyun 			+ INDEX_16_COUNT * sizeof(struct db_index)
595*4882a593Smuzhiyun 			+ VALUES_16_COUNT * sizeof(u16)
596*4882a593Smuzhiyun 			> sizeof(struct os_area_db));
597*4882a593Smuzhiyun }
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun /**
600*4882a593Smuzhiyun  * update_flash_db - Helper for os_area_queue_work_handler.
601*4882a593Smuzhiyun  *
602*4882a593Smuzhiyun  */
603*4882a593Smuzhiyun 
update_flash_db(void)604*4882a593Smuzhiyun static int update_flash_db(void)
605*4882a593Smuzhiyun {
606*4882a593Smuzhiyun 	const unsigned int buf_len = 8 * OS_AREA_SEGMENT_SIZE;
607*4882a593Smuzhiyun 	struct os_area_header *header;
608*4882a593Smuzhiyun 	ssize_t count;
609*4882a593Smuzhiyun 	int error;
610*4882a593Smuzhiyun 	loff_t pos;
611*4882a593Smuzhiyun 	struct os_area_db* db;
612*4882a593Smuzhiyun 
613*4882a593Smuzhiyun 	/* Read in header and db from flash. */
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 	header = kmalloc(buf_len, GFP_KERNEL);
616*4882a593Smuzhiyun 	if (!header)
617*4882a593Smuzhiyun 		return -ENOMEM;
618*4882a593Smuzhiyun 
619*4882a593Smuzhiyun 	count = os_area_flash_read(header, buf_len, 0);
620*4882a593Smuzhiyun 	if (count < 0) {
621*4882a593Smuzhiyun 		pr_debug("%s: os_area_flash_read failed %zd\n", __func__,
622*4882a593Smuzhiyun 			 count);
623*4882a593Smuzhiyun 		error = count;
624*4882a593Smuzhiyun 		goto fail;
625*4882a593Smuzhiyun 	}
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 	pos = header->db_area_offset * OS_AREA_SEGMENT_SIZE;
628*4882a593Smuzhiyun 	if (count < OS_AREA_SEGMENT_SIZE || verify_header(header) ||
629*4882a593Smuzhiyun 	    count < pos) {
630*4882a593Smuzhiyun 		pr_debug("%s: verify_header failed\n", __func__);
631*4882a593Smuzhiyun 		dump_header(header);
632*4882a593Smuzhiyun 		error = -EINVAL;
633*4882a593Smuzhiyun 		goto fail;
634*4882a593Smuzhiyun 	}
635*4882a593Smuzhiyun 
636*4882a593Smuzhiyun 	/* Now got a good db offset and some maybe good db data. */
637*4882a593Smuzhiyun 
638*4882a593Smuzhiyun 	db = (void *)header + pos;
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun 	error = db_verify(db);
641*4882a593Smuzhiyun 	if (error) {
642*4882a593Smuzhiyun 		pr_notice("%s: Verify of flash database failed, formatting.\n",
643*4882a593Smuzhiyun 			  __func__);
644*4882a593Smuzhiyun 		dump_db(db);
645*4882a593Smuzhiyun 		os_area_db_init(db);
646*4882a593Smuzhiyun 	}
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	/* Now got good db data. */
649*4882a593Smuzhiyun 
650*4882a593Smuzhiyun 	db_set_64(db, &os_area_db_id_rtc_diff, saved_params.rtc_diff);
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun 	count = os_area_flash_write(db, sizeof(struct os_area_db), pos);
653*4882a593Smuzhiyun 	if (count < 0 || count < sizeof(struct os_area_db)) {
654*4882a593Smuzhiyun 		pr_debug("%s: os_area_flash_write failed %zd\n", __func__,
655*4882a593Smuzhiyun 			 count);
656*4882a593Smuzhiyun 		error = count < 0 ? count : -EIO;
657*4882a593Smuzhiyun 	}
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun fail:
660*4882a593Smuzhiyun 	kfree(header);
661*4882a593Smuzhiyun 	return error;
662*4882a593Smuzhiyun }
663*4882a593Smuzhiyun 
664*4882a593Smuzhiyun /**
665*4882a593Smuzhiyun  * os_area_queue_work_handler - Asynchronous write handler.
666*4882a593Smuzhiyun  *
667*4882a593Smuzhiyun  * An asynchronous write for flash memory and the device tree.  Do not
668*4882a593Smuzhiyun  * call directly, use os_area_queue_work().
669*4882a593Smuzhiyun  */
670*4882a593Smuzhiyun 
os_area_queue_work_handler(struct work_struct * work)671*4882a593Smuzhiyun static void os_area_queue_work_handler(struct work_struct *work)
672*4882a593Smuzhiyun {
673*4882a593Smuzhiyun 	struct device_node *node;
674*4882a593Smuzhiyun 	int error;
675*4882a593Smuzhiyun 
676*4882a593Smuzhiyun 	pr_debug(" -> %s:%d\n", __func__, __LINE__);
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 	node = of_find_node_by_path("/");
679*4882a593Smuzhiyun 	if (node) {
680*4882a593Smuzhiyun 		os_area_set_property(node, &property_rtc_diff);
681*4882a593Smuzhiyun 		of_node_put(node);
682*4882a593Smuzhiyun 	} else
683*4882a593Smuzhiyun 		pr_debug("%s:%d of_find_node_by_path failed\n",
684*4882a593Smuzhiyun 			__func__, __LINE__);
685*4882a593Smuzhiyun 
686*4882a593Smuzhiyun 	error = update_flash_db();
687*4882a593Smuzhiyun 	if (error)
688*4882a593Smuzhiyun 		pr_warn("%s: Could not update FLASH ROM\n", __func__);
689*4882a593Smuzhiyun 
690*4882a593Smuzhiyun 	pr_debug(" <- %s:%d\n", __func__, __LINE__);
691*4882a593Smuzhiyun }
692*4882a593Smuzhiyun 
os_area_queue_work(void)693*4882a593Smuzhiyun static void os_area_queue_work(void)
694*4882a593Smuzhiyun {
695*4882a593Smuzhiyun 	static DECLARE_WORK(q, os_area_queue_work_handler);
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 	wmb();
698*4882a593Smuzhiyun 	schedule_work(&q);
699*4882a593Smuzhiyun }
700*4882a593Smuzhiyun 
701*4882a593Smuzhiyun /**
702*4882a593Smuzhiyun  * ps3_os_area_save_params - Copy data from os area mirror to @saved_params.
703*4882a593Smuzhiyun  *
704*4882a593Smuzhiyun  * For the convenience of the guest the HV makes a copy of the os area in
705*4882a593Smuzhiyun  * flash to a high address in the boot memory region and then puts that RAM
706*4882a593Smuzhiyun  * address and the byte count into the repository for retrieval by the guest.
707*4882a593Smuzhiyun  * We copy the data we want into a static variable and allow the memory setup
708*4882a593Smuzhiyun  * by the HV to be claimed by the memblock manager.
709*4882a593Smuzhiyun  *
710*4882a593Smuzhiyun  * The os area mirror will not be available to a second stage kernel, and
711*4882a593Smuzhiyun  * the header verify will fail.  In this case, the saved_params values will
712*4882a593Smuzhiyun  * be set from flash memory or the passed in device tree in ps3_os_area_init().
713*4882a593Smuzhiyun  */
714*4882a593Smuzhiyun 
ps3_os_area_save_params(void)715*4882a593Smuzhiyun void __init ps3_os_area_save_params(void)
716*4882a593Smuzhiyun {
717*4882a593Smuzhiyun 	int result;
718*4882a593Smuzhiyun 	u64 lpar_addr;
719*4882a593Smuzhiyun 	unsigned int size;
720*4882a593Smuzhiyun 	struct os_area_header *header;
721*4882a593Smuzhiyun 	struct os_area_params *params;
722*4882a593Smuzhiyun 	struct os_area_db *db;
723*4882a593Smuzhiyun 
724*4882a593Smuzhiyun 	pr_debug(" -> %s:%d\n", __func__, __LINE__);
725*4882a593Smuzhiyun 
726*4882a593Smuzhiyun 	result = ps3_repository_read_boot_dat_info(&lpar_addr, &size);
727*4882a593Smuzhiyun 
728*4882a593Smuzhiyun 	if (result) {
729*4882a593Smuzhiyun 		pr_debug("%s:%d ps3_repository_read_boot_dat_info failed\n",
730*4882a593Smuzhiyun 			__func__, __LINE__);
731*4882a593Smuzhiyun 		return;
732*4882a593Smuzhiyun 	}
733*4882a593Smuzhiyun 
734*4882a593Smuzhiyun 	header = (struct os_area_header *)__va(lpar_addr);
735*4882a593Smuzhiyun 	params = (struct os_area_params *)__va(lpar_addr
736*4882a593Smuzhiyun 		+ OS_AREA_SEGMENT_SIZE);
737*4882a593Smuzhiyun 
738*4882a593Smuzhiyun 	result = verify_header(header);
739*4882a593Smuzhiyun 
740*4882a593Smuzhiyun 	if (result) {
741*4882a593Smuzhiyun 		/* Second stage kernels exit here. */
742*4882a593Smuzhiyun 		pr_debug("%s:%d verify_header failed\n", __func__, __LINE__);
743*4882a593Smuzhiyun 		dump_header(header);
744*4882a593Smuzhiyun 		return;
745*4882a593Smuzhiyun 	}
746*4882a593Smuzhiyun 
747*4882a593Smuzhiyun 	db = (struct os_area_db *)__va(lpar_addr
748*4882a593Smuzhiyun 		+ header->db_area_offset * OS_AREA_SEGMENT_SIZE);
749*4882a593Smuzhiyun 
750*4882a593Smuzhiyun 	dump_header(header);
751*4882a593Smuzhiyun 	dump_params(params);
752*4882a593Smuzhiyun 	dump_db(db);
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun 	result = db_verify(db) || db_get_rtc_diff(db, &saved_params.rtc_diff);
755*4882a593Smuzhiyun 	if (result)
756*4882a593Smuzhiyun 		saved_params.rtc_diff = params->rtc_diff ? params->rtc_diff
757*4882a593Smuzhiyun 			: SECONDS_FROM_1970_TO_2000;
758*4882a593Smuzhiyun 	saved_params.av_multi_out = params->av_multi_out;
759*4882a593Smuzhiyun 	saved_params.valid = 1;
760*4882a593Smuzhiyun 
761*4882a593Smuzhiyun 	memset(header, 0, sizeof(*header));
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun 	pr_debug(" <- %s:%d\n", __func__, __LINE__);
764*4882a593Smuzhiyun }
765*4882a593Smuzhiyun 
766*4882a593Smuzhiyun /**
767*4882a593Smuzhiyun  * ps3_os_area_init - Setup os area device tree properties as needed.
768*4882a593Smuzhiyun  */
769*4882a593Smuzhiyun 
ps3_os_area_init(void)770*4882a593Smuzhiyun void __init ps3_os_area_init(void)
771*4882a593Smuzhiyun {
772*4882a593Smuzhiyun 	struct device_node *node;
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun 	pr_debug(" -> %s:%d\n", __func__, __LINE__);
775*4882a593Smuzhiyun 
776*4882a593Smuzhiyun 	node = of_find_node_by_path("/");
777*4882a593Smuzhiyun 
778*4882a593Smuzhiyun 	if (!saved_params.valid && node) {
779*4882a593Smuzhiyun 		/* Second stage kernels should have a dt entry. */
780*4882a593Smuzhiyun 		os_area_get_property(node, &property_rtc_diff);
781*4882a593Smuzhiyun 		os_area_get_property(node, &property_av_multi_out);
782*4882a593Smuzhiyun 	}
783*4882a593Smuzhiyun 
784*4882a593Smuzhiyun 	if(!saved_params.rtc_diff)
785*4882a593Smuzhiyun 		saved_params.rtc_diff = SECONDS_FROM_1970_TO_2000;
786*4882a593Smuzhiyun 
787*4882a593Smuzhiyun 	if (node) {
788*4882a593Smuzhiyun 		os_area_set_property(node, &property_rtc_diff);
789*4882a593Smuzhiyun 		os_area_set_property(node, &property_av_multi_out);
790*4882a593Smuzhiyun 		of_node_put(node);
791*4882a593Smuzhiyun 	} else
792*4882a593Smuzhiyun 		pr_debug("%s:%d of_find_node_by_path failed\n",
793*4882a593Smuzhiyun 			__func__, __LINE__);
794*4882a593Smuzhiyun 
795*4882a593Smuzhiyun 	pr_debug(" <- %s:%d\n", __func__, __LINE__);
796*4882a593Smuzhiyun }
797*4882a593Smuzhiyun 
798*4882a593Smuzhiyun /**
799*4882a593Smuzhiyun  * ps3_os_area_get_rtc_diff - Returns the rtc diff value.
800*4882a593Smuzhiyun  */
801*4882a593Smuzhiyun 
ps3_os_area_get_rtc_diff(void)802*4882a593Smuzhiyun u64 ps3_os_area_get_rtc_diff(void)
803*4882a593Smuzhiyun {
804*4882a593Smuzhiyun 	return saved_params.rtc_diff;
805*4882a593Smuzhiyun }
806*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(ps3_os_area_get_rtc_diff);
807*4882a593Smuzhiyun 
808*4882a593Smuzhiyun /**
809*4882a593Smuzhiyun  * ps3_os_area_set_rtc_diff - Set the rtc diff value.
810*4882a593Smuzhiyun  *
811*4882a593Smuzhiyun  * An asynchronous write is needed to support writing updates from
812*4882a593Smuzhiyun  * the timer interrupt context.
813*4882a593Smuzhiyun  */
814*4882a593Smuzhiyun 
ps3_os_area_set_rtc_diff(u64 rtc_diff)815*4882a593Smuzhiyun void ps3_os_area_set_rtc_diff(u64 rtc_diff)
816*4882a593Smuzhiyun {
817*4882a593Smuzhiyun 	if (saved_params.rtc_diff != rtc_diff) {
818*4882a593Smuzhiyun 		saved_params.rtc_diff = rtc_diff;
819*4882a593Smuzhiyun 		os_area_queue_work();
820*4882a593Smuzhiyun 	}
821*4882a593Smuzhiyun }
822*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(ps3_os_area_set_rtc_diff);
823*4882a593Smuzhiyun 
824*4882a593Smuzhiyun /**
825*4882a593Smuzhiyun  * ps3_os_area_get_av_multi_out - Returns the default video mode.
826*4882a593Smuzhiyun  */
827*4882a593Smuzhiyun 
ps3_os_area_get_av_multi_out(void)828*4882a593Smuzhiyun enum ps3_param_av_multi_out ps3_os_area_get_av_multi_out(void)
829*4882a593Smuzhiyun {
830*4882a593Smuzhiyun     return saved_params.av_multi_out;
831*4882a593Smuzhiyun }
832*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(ps3_os_area_get_av_multi_out);
833