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