os-area.c 22 KB

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