~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/arch/powerpc/platforms/ps3/os-area.c

Version: ~ [ linux-5.4-rc7 ] ~ [ linux-5.3.10 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.83 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.153 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.200 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.200 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.19.8 ] ~ [ linux-3.18.140 ] ~ [ linux-3.17.8 ] ~ [ linux-3.16.76 ] ~ [ linux-3.15.10 ] ~ [ linux-3.14.79 ] ~ [ linux-3.13.11 ] ~ [ linux-3.12.74 ] ~ [ linux-3.11.10 ] ~ [ linux-3.10.108 ] ~ [ linux-3.9.11 ] ~ [ linux-3.8.13 ] ~ [ linux-3.7.10 ] ~ [ linux-3.6.11 ] ~ [ linux-3.5.7 ] ~ [ linux-3.4.113 ] ~ [ linux-3.3.8 ] ~ [ linux-3.2.102 ] ~ [ linux-3.1.10 ] ~ [ linux-3.0.101 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

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

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp