Changes in 4.9.204 net/mlx4_en: fix mlx4 ethtool -N insertion net: rtnetlink: prevent underflows in do_setvfinfo() sfc: Only cancel the PPS workqueue if it exists net/mlx5e: Fix set vf link state error flow net/sched: act_pedit: fix WARN() in the traffic path gpio: max77620: Fixup debounce delays tools: gpio: Correctly add make dependencies for gpio_utils Revert "fs: ocfs2: fix possible null-pointer dereferences in ocfs2_xa_prepare_entry()" mm/ksm.c: don't WARN if page is still mapped in remove_stable_node() platform/x86: asus-nb-wmi: Support ALS on the Zenbook UX430UQ platform/x86: asus-wmi: Only Tell EC the OS will handle display hotkeys from asus_nb_wmi mwifiex: Fix NL80211_TX_POWER_LIMITED ALSA: isight: fix leak of reference to firewire unit in error path of .probe callback printk: fix integer overflow in setup_log_buf() gfs2: Fix marking bitmaps non-full synclink_gt(): fix compat_ioctl() powerpc: Fix signedness bug in update_flash_db() powerpc/eeh: Fix use of EEH_PE_KEEP on wrong field brcmsmac: AP mode: update beacon when TIM changes ath10k: allocate small size dma memory in ath10k_pci_diag_write_mem spi: sh-msiof: fix deferred probing mmc: mediatek: fix cannot receive new request when msdc_cmd_is_ready fail btrfs: handle error of get_old_root gsmi: Fix bug in append_to_eventlog sysfs handler misc: mic: fix a DMA pool free failure m68k: fix command-line parsing when passed from u-boot amiflop: clean up on errors during setup scsi: ips: fix missing break in switch KVM/x86: Fix invvpid and invept register operand size in 64-bit mode scsi: isci: Use proper enumerated type in atapi_d2h_reg_frame_handler scsi: isci: Change sci_controller_start_task's return type to sci_status scsi: iscsi_tcp: Explicitly cast param in iscsi_sw_tcp_host_get_param clk: mmp2: fix the clock id for sdh2_clk and sdh3_clk ASoC: tegra_sgtl5000: fix device_node refcounting scsi: dc395x: fix dma API usage in srb_done scsi: dc395x: fix DMA API usage in sg_update_list net: fix warning in af_unix net: ena: Fix Kconfig dependency on X86 xfs: fix use-after-free race in xfs_buf_rele kprobes, x86/ptrace.h: Make regs_get_kernel_stack_nth() not fault on bad stack ALSA: i2c/cs8427: Fix int to char conversion macintosh/windfarm_smu_sat: Fix debug output USB: misc: appledisplay: fix backlight update_status return code usbip: tools: fix atoi() on non-null terminated string SUNRPC: Fix a compile warning for cmpxchg64() sunrpc: safely reallow resvport min/max inversion atm: zatm: Fix empty body Clang warnings s390/perf: Return error when debug_register fails spi: omap2-mcspi: Set FIFO DMA trigger level to word length sparc: Fix parport build warnings. ceph: fix dentry leak in ceph_readdir_prepopulate rtc: s35390a: Change buf's type to u8 in s35390a_init f2fs: fix to spread clear_cold_data() mISDN: Fix type of switch control variable in ctrl_teimanager qlcnic: fix a return in qlcnic_dcb_get_capability() net: ethernet: ti: cpsw: unsync mcast entries while switch promisc mode mfd: arizona: Correct calling of runtime_put_sync mfd: mc13xxx-core: Fix PMIC shutdown when reading ADC values mfd: max8997: Enale irq-wakeup unconditionally selftests/ftrace: Fix to test kprobe $comm arg only if available thermal: rcar_thermal: Prevent hardware access during system suspend powerpc/process: Fix flush_all_to_thread for SPE sparc64: Rework xchg() definition to avoid warnings. fs/ocfs2/dlm/dlmdebug.c: fix a sleep-in-atomic-context bug in dlm_print_one_mle() mm/page-writeback.c: fix range_cyclic writeback vs writepages deadlock macsec: update operstate when lower device changes macsec: let the administrator set UP state even if lowerdev is down um: Make line/tty semantics use true write IRQ linux/bitmap.h: handle constant zero-size bitmaps correctly linux/bitmap.h: fix type of nbits in bitmap_shift_right() hfsplus: fix BUG on bnode parent update hfs: fix BUG on bnode parent update hfsplus: prevent btree data loss on ENOSPC hfs: prevent btree data loss on ENOSPC hfsplus: fix return value of hfsplus_get_block() hfs: fix return value of hfs_get_block() hfsplus: update timestamps on truncate() hfs: update timestamp on truncate() fs/hfs/extent.c: fix array out of bounds read of array extent mm/memory_hotplug: make add_memory() take the device_hotplug_lock igb: shorten maximum PHC timecounter update interval ntb_netdev: fix sleep time mismatch ntb: intel: fix return value for ndev_vec_mask() arm64: makefile fix build of .i file in external module case ocfs2: don't put and assigning null to bh allocated outside ocfs2: fix clusters leak in ocfs2_defrag_extent() net: do not abort bulk send on BQL status sched/fair: Don't increase sd->balance_interval on newidle balance audit: print empty EXECVE args wlcore: Fix the return value in case of error in 'wlcore_vendor_cmd_smart_config_start()' rtl8xxxu: Fix missing break in switch brcmsmac: never log "tid x is not agg'able" by default wireless: airo: potential buffer overflow in sprintf() rtlwifi: rtl8192de: Fix misleading REG_MCUFWDL information scsi: mpt3sas: Fix Sync cache command failure during driver unload scsi: mpt3sas: Fix driver modifying persistent data in Manufacturing page11 scsi: megaraid_sas: Fix msleep granularity scsi: lpfc: fcoe: Fix link down issue after 1000+ link bounces dlm: fix invalid free dlm: don't leak kernel pointer to userspace ACPICA: Use %d for signed int print formatting instead of %u net: bcmgenet: return correct value 'ret' from bcmgenet_power_down sock: Reset dst when changing sk_mark via setsockopt pinctrl: qcom: spmi-gpio: fix gpio-hog related boot issues pinctrl: lpc18xx: Use define directive for PIN_CONFIG_GPIO_PIN_INT pinctrl: zynq: Use define directive for PIN_CONFIG_IO_STANDARD PCI: keystone: Use quirk to limit MRRS for K2G spi: omap2-mcspi: Fix DMA and FIFO event trigger size mismatch mm/memory_hotplug: Do not unlock when fails to take the device_hotplug_lock Bluetooth: Fix invalid-free in bcsp_close() KVM: MMU: Do not treat ZONE_DEVICE pages as being reserved ath9k_hw: fix uninitialized variable data dm: use blk_set_queue_dying() in __dm_destroy() arm64: fix for bad_mode() handler to always result in panic cpufreq: Skip cpufreq resume if it's not suspended ocfs2: remove ocfs2_is_o2cb_active() ARM: 8904/1: skip nomap memblocks while finding the lowmem/highmem boundary ARC: perf: Accommodate big-endian CPU x86/insn: Fix awk regexp warnings x86/speculation: Fix incorrect MDS/TAA mitigation status x86/speculation: Fix redundant MDS mitigation message nfc: port100: handle command failure cleanly l2tp: don't use l2tp_tunnel_find() in l2tp_ip and l2tp_ip6 media: vivid: Set vid_cap_streaming and vid_out_streaming to true media: vivid: Fix wrong locking that causes race conditions on streaming stop media: usbvision: Fix races among open, close, and disconnect cpufreq: Add NULL checks to show() and store() methods of cpufreq media: uvcvideo: Fix error path in control parsing failure media: b2c2-flexcop-usb: add sanity checking media: cxusb: detect cxusb_ctrl_msg error in query media: imon: invalid dereference in imon_touch_event virtio_console: reset on out of memory virtio_console: don't tie bufs to a vq virtio_console: allocate inbufs in add_port() only if it is needed virtio_ring: fix return code on DMA mapping fails virtio_console: fix uninitialized variable use virtio_console: drop custom control queue cleanup virtio_console: move removal code usbip: tools: fix fd leakage in the function of read_attr_usbip_status usb-serial: cp201x: support Mark-10 digital force gauge USB: chaoskey: fix error case of a timeout appledisplay: fix error handling in the scheduled work USB: serial: mos7840: add USB ID to support Moxa UPort 2210 USB: serial: mos7720: fix remote wakeup USB: serial: mos7840: fix remote wakeup USB: serial: option: add support for DW5821e with eSIM support USB: serial: option: add support for Foxconn T77W968 LTE modules staging: comedi: usbduxfast: usbduxfast_ai_cmdtest rounding error powerpc/64s: support nospectre_v2 cmdline option powerpc/book3s64: Fix link stack flush on context switch KVM: PPC: Book3S HV: Flush link stack on guest exit to host kernel Linux 4.9.204 Signed-off-by: Greg Kroah-Hartman <gregkh@google.com>
847 lines
22 KiB
C
847 lines
22 KiB
C
/*
|
|
* PS3 flash memory os area.
|
|
*
|
|
* Copyright (C) 2006 Sony Computer Entertainment Inc.
|
|
* Copyright 2006 Sony Corp.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/io.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/syscalls.h>
|
|
#include <linux/export.h>
|
|
#include <linux/ctype.h>
|
|
#include <linux/memblock.h>
|
|
#include <linux/of.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include <asm/prom.h>
|
|
|
|
#include "platform.h"
|
|
|
|
enum {
|
|
OS_AREA_SEGMENT_SIZE = 0X200,
|
|
};
|
|
|
|
enum os_area_ldr_format {
|
|
HEADER_LDR_FORMAT_RAW = 0,
|
|
HEADER_LDR_FORMAT_GZIP = 1,
|
|
};
|
|
|
|
#define OS_AREA_HEADER_MAGIC_NUM "cell_ext_os_area"
|
|
|
|
/**
|
|
* struct os_area_header - os area header segment.
|
|
* @magic_num: Always 'cell_ext_os_area'.
|
|
* @hdr_version: Header format version number.
|
|
* @db_area_offset: Starting segment number of other os database area.
|
|
* @ldr_area_offset: Starting segment number of bootloader image area.
|
|
* @ldr_format: HEADER_LDR_FORMAT flag.
|
|
* @ldr_size: Size of bootloader image in bytes.
|
|
*
|
|
* Note that the docs refer to area offsets. These are offsets in units of
|
|
* segments from the start of the os area (top of the header). These are
|
|
* better thought of as segment numbers. The os area of the os area is
|
|
* reserved for the os image.
|
|
*/
|
|
|
|
struct os_area_header {
|
|
u8 magic_num[16];
|
|
u32 hdr_version;
|
|
u32 db_area_offset;
|
|
u32 ldr_area_offset;
|
|
u32 _reserved_1;
|
|
u32 ldr_format;
|
|
u32 ldr_size;
|
|
u32 _reserved_2[6];
|
|
};
|
|
|
|
enum os_area_boot_flag {
|
|
PARAM_BOOT_FLAG_GAME_OS = 0,
|
|
PARAM_BOOT_FLAG_OTHER_OS = 1,
|
|
};
|
|
|
|
enum os_area_ctrl_button {
|
|
PARAM_CTRL_BUTTON_O_IS_YES = 0,
|
|
PARAM_CTRL_BUTTON_X_IS_YES = 1,
|
|
};
|
|
|
|
/**
|
|
* struct os_area_params - os area params segment.
|
|
* @boot_flag: User preference of operating system, PARAM_BOOT_FLAG flag.
|
|
* @num_params: Number of params in this (params) segment.
|
|
* @rtc_diff: Difference in seconds between 1970 and the ps3 rtc value.
|
|
* @av_multi_out: User preference of AV output, PARAM_AV_MULTI_OUT flag.
|
|
* @ctrl_button: User preference of controller button config, PARAM_CTRL_BUTTON
|
|
* flag.
|
|
* @static_ip_addr: User preference of static IP address.
|
|
* @network_mask: User preference of static network mask.
|
|
* @default_gateway: User preference of static default gateway.
|
|
* @dns_primary: User preference of static primary dns server.
|
|
* @dns_secondary: User preference of static secondary dns server.
|
|
*
|
|
* The ps3 rtc maintains a read-only value that approximates seconds since
|
|
* 2000-01-01 00:00:00 UTC.
|
|
*
|
|
* User preference of zero for static_ip_addr means use dhcp.
|
|
*/
|
|
|
|
struct os_area_params {
|
|
u32 boot_flag;
|
|
u32 _reserved_1[3];
|
|
u32 num_params;
|
|
u32 _reserved_2[3];
|
|
/* param 0 */
|
|
s64 rtc_diff;
|
|
u8 av_multi_out;
|
|
u8 ctrl_button;
|
|
u8 _reserved_3[6];
|
|
/* param 1 */
|
|
u8 static_ip_addr[4];
|
|
u8 network_mask[4];
|
|
u8 default_gateway[4];
|
|
u8 _reserved_4[4];
|
|
/* param 2 */
|
|
u8 dns_primary[4];
|
|
u8 dns_secondary[4];
|
|
u8 _reserved_5[8];
|
|
};
|
|
|
|
#define OS_AREA_DB_MAGIC_NUM "-db-"
|
|
|
|
/**
|
|
* struct os_area_db - Shared flash memory database.
|
|
* @magic_num: Always '-db-'.
|
|
* @version: os_area_db format version number.
|
|
* @index_64: byte offset of the database id index for 64 bit variables.
|
|
* @count_64: number of usable 64 bit index entries
|
|
* @index_32: byte offset of the database id index for 32 bit variables.
|
|
* @count_32: number of usable 32 bit index entries
|
|
* @index_16: byte offset of the database id index for 16 bit variables.
|
|
* @count_16: number of usable 16 bit index entries
|
|
*
|
|
* Flash rom storage for exclusive use by guests running in the other os lpar.
|
|
* The current system configuration allocates 1K (two segments) for other os
|
|
* use.
|
|
*/
|
|
|
|
struct os_area_db {
|
|
u8 magic_num[4];
|
|
u16 version;
|
|
u16 _reserved_1;
|
|
u16 index_64;
|
|
u16 count_64;
|
|
u16 index_32;
|
|
u16 count_32;
|
|
u16 index_16;
|
|
u16 count_16;
|
|
u32 _reserved_2;
|
|
u8 _db_data[1000];
|
|
};
|
|
|
|
/**
|
|
* enum os_area_db_owner - Data owners.
|
|
*/
|
|
|
|
enum os_area_db_owner {
|
|
OS_AREA_DB_OWNER_ANY = -1,
|
|
OS_AREA_DB_OWNER_NONE = 0,
|
|
OS_AREA_DB_OWNER_PROTOTYPE = 1,
|
|
OS_AREA_DB_OWNER_LINUX = 2,
|
|
OS_AREA_DB_OWNER_PETITBOOT = 3,
|
|
OS_AREA_DB_OWNER_MAX = 32,
|
|
};
|
|
|
|
enum os_area_db_key {
|
|
OS_AREA_DB_KEY_ANY = -1,
|
|
OS_AREA_DB_KEY_NONE = 0,
|
|
OS_AREA_DB_KEY_RTC_DIFF = 1,
|
|
OS_AREA_DB_KEY_VIDEO_MODE = 2,
|
|
OS_AREA_DB_KEY_MAX = 8,
|
|
};
|
|
|
|
struct os_area_db_id {
|
|
int owner;
|
|
int key;
|
|
};
|
|
|
|
static const struct os_area_db_id os_area_db_id_empty = {
|
|
.owner = OS_AREA_DB_OWNER_NONE,
|
|
.key = OS_AREA_DB_KEY_NONE
|
|
};
|
|
|
|
static const struct os_area_db_id os_area_db_id_any = {
|
|
.owner = OS_AREA_DB_OWNER_ANY,
|
|
.key = OS_AREA_DB_KEY_ANY
|
|
};
|
|
|
|
static const struct os_area_db_id os_area_db_id_rtc_diff = {
|
|
.owner = OS_AREA_DB_OWNER_LINUX,
|
|
.key = OS_AREA_DB_KEY_RTC_DIFF
|
|
};
|
|
|
|
#define SECONDS_FROM_1970_TO_2000 946684800LL
|
|
|
|
/**
|
|
* struct saved_params - Static working copies of data from the PS3 'os area'.
|
|
*
|
|
* The order of preference we use for the rtc_diff source:
|
|
* 1) The database value.
|
|
* 2) The game os value.
|
|
* 3) The number of seconds from 1970 to 2000.
|
|
*/
|
|
|
|
struct saved_params {
|
|
unsigned int valid;
|
|
s64 rtc_diff;
|
|
unsigned int av_multi_out;
|
|
} static saved_params;
|
|
|
|
static struct property property_rtc_diff = {
|
|
.name = "linux,rtc_diff",
|
|
.length = sizeof(saved_params.rtc_diff),
|
|
.value = &saved_params.rtc_diff,
|
|
};
|
|
|
|
static struct property property_av_multi_out = {
|
|
.name = "linux,av_multi_out",
|
|
.length = sizeof(saved_params.av_multi_out),
|
|
.value = &saved_params.av_multi_out,
|
|
};
|
|
|
|
|
|
static DEFINE_MUTEX(os_area_flash_mutex);
|
|
|
|
static const struct ps3_os_area_flash_ops *os_area_flash_ops;
|
|
|
|
void ps3_os_area_flash_register(const struct ps3_os_area_flash_ops *ops)
|
|
{
|
|
mutex_lock(&os_area_flash_mutex);
|
|
os_area_flash_ops = ops;
|
|
mutex_unlock(&os_area_flash_mutex);
|
|
}
|
|
EXPORT_SYMBOL_GPL(ps3_os_area_flash_register);
|
|
|
|
static ssize_t os_area_flash_read(void *buf, size_t count, loff_t pos)
|
|
{
|
|
ssize_t res = -ENODEV;
|
|
|
|
mutex_lock(&os_area_flash_mutex);
|
|
if (os_area_flash_ops)
|
|
res = os_area_flash_ops->read(buf, count, pos);
|
|
mutex_unlock(&os_area_flash_mutex);
|
|
|
|
return res;
|
|
}
|
|
|
|
static ssize_t os_area_flash_write(const void *buf, size_t count, loff_t pos)
|
|
{
|
|
ssize_t res = -ENODEV;
|
|
|
|
mutex_lock(&os_area_flash_mutex);
|
|
if (os_area_flash_ops)
|
|
res = os_area_flash_ops->write(buf, count, pos);
|
|
mutex_unlock(&os_area_flash_mutex);
|
|
|
|
return res;
|
|
}
|
|
|
|
|
|
/**
|
|
* os_area_set_property - Add or overwrite a saved_params value to the device tree.
|
|
*
|
|
* Overwrites an existing property.
|
|
*/
|
|
|
|
static void os_area_set_property(struct device_node *node,
|
|
struct property *prop)
|
|
{
|
|
int result;
|
|
struct property *tmp = of_find_property(node, prop->name, NULL);
|
|
|
|
if (tmp) {
|
|
pr_debug("%s:%d found %s\n", __func__, __LINE__, prop->name);
|
|
of_remove_property(node, tmp);
|
|
}
|
|
|
|
result = of_add_property(node, prop);
|
|
|
|
if (result)
|
|
pr_debug("%s:%d of_set_property failed\n", __func__,
|
|
__LINE__);
|
|
}
|
|
|
|
/**
|
|
* os_area_get_property - Get a saved_params value from the device tree.
|
|
*
|
|
*/
|
|
|
|
static void __init os_area_get_property(struct device_node *node,
|
|
struct property *prop)
|
|
{
|
|
const struct property *tmp = of_find_property(node, prop->name, NULL);
|
|
|
|
if (tmp) {
|
|
BUG_ON(prop->length != tmp->length);
|
|
memcpy(prop->value, tmp->value, prop->length);
|
|
} else
|
|
pr_debug("%s:%d not found %s\n", __func__, __LINE__,
|
|
prop->name);
|
|
}
|
|
|
|
static void dump_field(char *s, const u8 *field, int size_of_field)
|
|
{
|
|
#if defined(DEBUG)
|
|
int i;
|
|
|
|
for (i = 0; i < size_of_field; i++)
|
|
s[i] = isprint(field[i]) ? field[i] : '.';
|
|
s[i] = 0;
|
|
#endif
|
|
}
|
|
|
|
#define dump_header(_a) _dump_header(_a, __func__, __LINE__)
|
|
static void _dump_header(const struct os_area_header *h, const char *func,
|
|
int line)
|
|
{
|
|
char str[sizeof(h->magic_num) + 1];
|
|
|
|
dump_field(str, h->magic_num, sizeof(h->magic_num));
|
|
pr_debug("%s:%d: h.magic_num: '%s'\n", func, line,
|
|
str);
|
|
pr_debug("%s:%d: h.hdr_version: %u\n", func, line,
|
|
h->hdr_version);
|
|
pr_debug("%s:%d: h.db_area_offset: %u\n", func, line,
|
|
h->db_area_offset);
|
|
pr_debug("%s:%d: h.ldr_area_offset: %u\n", func, line,
|
|
h->ldr_area_offset);
|
|
pr_debug("%s:%d: h.ldr_format: %u\n", func, line,
|
|
h->ldr_format);
|
|
pr_debug("%s:%d: h.ldr_size: %xh\n", func, line,
|
|
h->ldr_size);
|
|
}
|
|
|
|
#define dump_params(_a) _dump_params(_a, __func__, __LINE__)
|
|
static void _dump_params(const struct os_area_params *p, const char *func,
|
|
int line)
|
|
{
|
|
pr_debug("%s:%d: p.boot_flag: %u\n", func, line, p->boot_flag);
|
|
pr_debug("%s:%d: p.num_params: %u\n", func, line, p->num_params);
|
|
pr_debug("%s:%d: p.rtc_diff %lld\n", func, line, p->rtc_diff);
|
|
pr_debug("%s:%d: p.av_multi_out %u\n", func, line, p->av_multi_out);
|
|
pr_debug("%s:%d: p.ctrl_button: %u\n", func, line, p->ctrl_button);
|
|
pr_debug("%s:%d: p.static_ip_addr: %u.%u.%u.%u\n", func, line,
|
|
p->static_ip_addr[0], p->static_ip_addr[1],
|
|
p->static_ip_addr[2], p->static_ip_addr[3]);
|
|
pr_debug("%s:%d: p.network_mask: %u.%u.%u.%u\n", func, line,
|
|
p->network_mask[0], p->network_mask[1],
|
|
p->network_mask[2], p->network_mask[3]);
|
|
pr_debug("%s:%d: p.default_gateway: %u.%u.%u.%u\n", func, line,
|
|
p->default_gateway[0], p->default_gateway[1],
|
|
p->default_gateway[2], p->default_gateway[3]);
|
|
pr_debug("%s:%d: p.dns_primary: %u.%u.%u.%u\n", func, line,
|
|
p->dns_primary[0], p->dns_primary[1],
|
|
p->dns_primary[2], p->dns_primary[3]);
|
|
pr_debug("%s:%d: p.dns_secondary: %u.%u.%u.%u\n", func, line,
|
|
p->dns_secondary[0], p->dns_secondary[1],
|
|
p->dns_secondary[2], p->dns_secondary[3]);
|
|
}
|
|
|
|
static int verify_header(const struct os_area_header *header)
|
|
{
|
|
if (memcmp(header->magic_num, OS_AREA_HEADER_MAGIC_NUM,
|
|
sizeof(header->magic_num))) {
|
|
pr_debug("%s:%d magic_num failed\n", __func__, __LINE__);
|
|
return -1;
|
|
}
|
|
|
|
if (header->hdr_version < 1) {
|
|
pr_debug("%s:%d hdr_version failed\n", __func__, __LINE__);
|
|
return -1;
|
|
}
|
|
|
|
if (header->db_area_offset > header->ldr_area_offset) {
|
|
pr_debug("%s:%d offsets failed\n", __func__, __LINE__);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int db_verify(const struct os_area_db *db)
|
|
{
|
|
if (memcmp(db->magic_num, OS_AREA_DB_MAGIC_NUM,
|
|
sizeof(db->magic_num))) {
|
|
pr_debug("%s:%d magic_num failed\n", __func__, __LINE__);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (db->version != 1) {
|
|
pr_debug("%s:%d version failed\n", __func__, __LINE__);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct db_index {
|
|
uint8_t owner:5;
|
|
uint8_t key:3;
|
|
};
|
|
|
|
struct db_iterator {
|
|
const struct os_area_db *db;
|
|
struct os_area_db_id match_id;
|
|
struct db_index *idx;
|
|
struct db_index *last_idx;
|
|
union {
|
|
uint64_t *value_64;
|
|
uint32_t *value_32;
|
|
uint16_t *value_16;
|
|
};
|
|
};
|
|
|
|
static unsigned int db_align_up(unsigned int val, unsigned int size)
|
|
{
|
|
return (val + (size - 1)) & (~(size - 1));
|
|
}
|
|
|
|
/**
|
|
* db_for_each_64 - Iterator for 64 bit entries.
|
|
*
|
|
* A NULL value for id can be used to match all entries.
|
|
* OS_AREA_DB_OWNER_ANY and OS_AREA_DB_KEY_ANY can be used to match all.
|
|
*/
|
|
|
|
static int db_for_each_64(const struct os_area_db *db,
|
|
const struct os_area_db_id *match_id, struct db_iterator *i)
|
|
{
|
|
next:
|
|
if (!i->db) {
|
|
i->db = db;
|
|
i->match_id = match_id ? *match_id : os_area_db_id_any;
|
|
i->idx = (void *)db + db->index_64;
|
|
i->last_idx = i->idx + db->count_64;
|
|
i->value_64 = (void *)db + db->index_64
|
|
+ db_align_up(db->count_64, 8);
|
|
} else {
|
|
i->idx++;
|
|
i->value_64++;
|
|
}
|
|
|
|
if (i->idx >= i->last_idx) {
|
|
pr_debug("%s:%d: reached end\n", __func__, __LINE__);
|
|
return 0;
|
|
}
|
|
|
|
if (i->match_id.owner != OS_AREA_DB_OWNER_ANY
|
|
&& i->match_id.owner != (int)i->idx->owner)
|
|
goto next;
|
|
if (i->match_id.key != OS_AREA_DB_KEY_ANY
|
|
&& i->match_id.key != (int)i->idx->key)
|
|
goto next;
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int db_delete_64(struct os_area_db *db, const struct os_area_db_id *id)
|
|
{
|
|
struct db_iterator i;
|
|
|
|
for (i.db = NULL; db_for_each_64(db, id, &i); ) {
|
|
|
|
pr_debug("%s:%d: got (%d:%d) %llxh\n", __func__, __LINE__,
|
|
i.idx->owner, i.idx->key,
|
|
(unsigned long long)*i.value_64);
|
|
|
|
i.idx->owner = 0;
|
|
i.idx->key = 0;
|
|
*i.value_64 = 0;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int db_set_64(struct os_area_db *db, const struct os_area_db_id *id,
|
|
uint64_t value)
|
|
{
|
|
struct db_iterator i;
|
|
|
|
pr_debug("%s:%d: (%d:%d) <= %llxh\n", __func__, __LINE__,
|
|
id->owner, id->key, (unsigned long long)value);
|
|
|
|
if (!id->owner || id->owner == OS_AREA_DB_OWNER_ANY
|
|
|| id->key == OS_AREA_DB_KEY_ANY) {
|
|
pr_debug("%s:%d: bad id: (%d:%d)\n", __func__,
|
|
__LINE__, id->owner, id->key);
|
|
return -1;
|
|
}
|
|
|
|
db_delete_64(db, id);
|
|
|
|
i.db = NULL;
|
|
if (db_for_each_64(db, &os_area_db_id_empty, &i)) {
|
|
|
|
pr_debug("%s:%d: got (%d:%d) %llxh\n", __func__, __LINE__,
|
|
i.idx->owner, i.idx->key,
|
|
(unsigned long long)*i.value_64);
|
|
|
|
i.idx->owner = id->owner;
|
|
i.idx->key = id->key;
|
|
*i.value_64 = value;
|
|
|
|
pr_debug("%s:%d: set (%d:%d) <= %llxh\n", __func__, __LINE__,
|
|
i.idx->owner, i.idx->key,
|
|
(unsigned long long)*i.value_64);
|
|
return 0;
|
|
}
|
|
pr_debug("%s:%d: database full.\n",
|
|
__func__, __LINE__);
|
|
return -1;
|
|
}
|
|
|
|
static int db_get_64(const struct os_area_db *db,
|
|
const struct os_area_db_id *id, uint64_t *value)
|
|
{
|
|
struct db_iterator i;
|
|
|
|
i.db = NULL;
|
|
if (db_for_each_64(db, id, &i)) {
|
|
*value = *i.value_64;
|
|
pr_debug("%s:%d: found %lld\n", __func__, __LINE__,
|
|
(long long int)*i.value_64);
|
|
return 0;
|
|
}
|
|
pr_debug("%s:%d: not found\n", __func__, __LINE__);
|
|
return -1;
|
|
}
|
|
|
|
static int db_get_rtc_diff(const struct os_area_db *db, int64_t *rtc_diff)
|
|
{
|
|
return db_get_64(db, &os_area_db_id_rtc_diff, (uint64_t*)rtc_diff);
|
|
}
|
|
|
|
#define dump_db(a) _dump_db(a, __func__, __LINE__)
|
|
static void _dump_db(const struct os_area_db *db, const char *func,
|
|
int line)
|
|
{
|
|
char str[sizeof(db->magic_num) + 1];
|
|
|
|
dump_field(str, db->magic_num, sizeof(db->magic_num));
|
|
pr_debug("%s:%d: db.magic_num: '%s'\n", func, line,
|
|
str);
|
|
pr_debug("%s:%d: db.version: %u\n", func, line,
|
|
db->version);
|
|
pr_debug("%s:%d: db.index_64: %u\n", func, line,
|
|
db->index_64);
|
|
pr_debug("%s:%d: db.count_64: %u\n", func, line,
|
|
db->count_64);
|
|
pr_debug("%s:%d: db.index_32: %u\n", func, line,
|
|
db->index_32);
|
|
pr_debug("%s:%d: db.count_32: %u\n", func, line,
|
|
db->count_32);
|
|
pr_debug("%s:%d: db.index_16: %u\n", func, line,
|
|
db->index_16);
|
|
pr_debug("%s:%d: db.count_16: %u\n", func, line,
|
|
db->count_16);
|
|
}
|
|
|
|
static void os_area_db_init(struct os_area_db *db)
|
|
{
|
|
enum {
|
|
HEADER_SIZE = offsetof(struct os_area_db, _db_data),
|
|
INDEX_64_COUNT = 64,
|
|
VALUES_64_COUNT = 57,
|
|
INDEX_32_COUNT = 64,
|
|
VALUES_32_COUNT = 57,
|
|
INDEX_16_COUNT = 64,
|
|
VALUES_16_COUNT = 57,
|
|
};
|
|
|
|
memset(db, 0, sizeof(struct os_area_db));
|
|
|
|
memcpy(db->magic_num, OS_AREA_DB_MAGIC_NUM, sizeof(db->magic_num));
|
|
db->version = 1;
|
|
db->index_64 = HEADER_SIZE;
|
|
db->count_64 = VALUES_64_COUNT;
|
|
db->index_32 = HEADER_SIZE
|
|
+ INDEX_64_COUNT * sizeof(struct db_index)
|
|
+ VALUES_64_COUNT * sizeof(u64);
|
|
db->count_32 = VALUES_32_COUNT;
|
|
db->index_16 = HEADER_SIZE
|
|
+ INDEX_64_COUNT * sizeof(struct db_index)
|
|
+ VALUES_64_COUNT * sizeof(u64)
|
|
+ INDEX_32_COUNT * sizeof(struct db_index)
|
|
+ VALUES_32_COUNT * sizeof(u32);
|
|
db->count_16 = VALUES_16_COUNT;
|
|
|
|
/* Rules to check db layout. */
|
|
|
|
BUILD_BUG_ON(sizeof(struct db_index) != 1);
|
|
BUILD_BUG_ON(sizeof(struct os_area_db) != 2 * OS_AREA_SEGMENT_SIZE);
|
|
BUILD_BUG_ON(INDEX_64_COUNT & 0x7);
|
|
BUILD_BUG_ON(VALUES_64_COUNT > INDEX_64_COUNT);
|
|
BUILD_BUG_ON(INDEX_32_COUNT & 0x7);
|
|
BUILD_BUG_ON(VALUES_32_COUNT > INDEX_32_COUNT);
|
|
BUILD_BUG_ON(INDEX_16_COUNT & 0x7);
|
|
BUILD_BUG_ON(VALUES_16_COUNT > INDEX_16_COUNT);
|
|
BUILD_BUG_ON(HEADER_SIZE
|
|
+ INDEX_64_COUNT * sizeof(struct db_index)
|
|
+ VALUES_64_COUNT * sizeof(u64)
|
|
+ INDEX_32_COUNT * sizeof(struct db_index)
|
|
+ VALUES_32_COUNT * sizeof(u32)
|
|
+ INDEX_16_COUNT * sizeof(struct db_index)
|
|
+ VALUES_16_COUNT * sizeof(u16)
|
|
> sizeof(struct os_area_db));
|
|
}
|
|
|
|
/**
|
|
* update_flash_db - Helper for os_area_queue_work_handler.
|
|
*
|
|
*/
|
|
|
|
static int update_flash_db(void)
|
|
{
|
|
const unsigned int buf_len = 8 * OS_AREA_SEGMENT_SIZE;
|
|
struct os_area_header *header;
|
|
ssize_t count;
|
|
int error;
|
|
loff_t pos;
|
|
struct os_area_db* db;
|
|
|
|
/* Read in header and db from flash. */
|
|
|
|
header = kmalloc(buf_len, GFP_KERNEL);
|
|
if (!header) {
|
|
pr_debug("%s: kmalloc failed\n", __func__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
count = os_area_flash_read(header, buf_len, 0);
|
|
if (count < 0) {
|
|
pr_debug("%s: os_area_flash_read failed %zd\n", __func__,
|
|
count);
|
|
error = count;
|
|
goto fail;
|
|
}
|
|
|
|
pos = header->db_area_offset * OS_AREA_SEGMENT_SIZE;
|
|
if (count < OS_AREA_SEGMENT_SIZE || verify_header(header) ||
|
|
count < pos) {
|
|
pr_debug("%s: verify_header failed\n", __func__);
|
|
dump_header(header);
|
|
error = -EINVAL;
|
|
goto fail;
|
|
}
|
|
|
|
/* Now got a good db offset and some maybe good db data. */
|
|
|
|
db = (void *)header + pos;
|
|
|
|
error = db_verify(db);
|
|
if (error) {
|
|
pr_notice("%s: Verify of flash database failed, formatting.\n",
|
|
__func__);
|
|
dump_db(db);
|
|
os_area_db_init(db);
|
|
}
|
|
|
|
/* Now got good db data. */
|
|
|
|
db_set_64(db, &os_area_db_id_rtc_diff, saved_params.rtc_diff);
|
|
|
|
count = os_area_flash_write(db, sizeof(struct os_area_db), pos);
|
|
if (count < 0 || count < sizeof(struct os_area_db)) {
|
|
pr_debug("%s: os_area_flash_write failed %zd\n", __func__,
|
|
count);
|
|
error = count < 0 ? count : -EIO;
|
|
}
|
|
|
|
fail:
|
|
kfree(header);
|
|
return error;
|
|
}
|
|
|
|
/**
|
|
* os_area_queue_work_handler - Asynchronous write handler.
|
|
*
|
|
* An asynchronous write for flash memory and the device tree. Do not
|
|
* call directly, use os_area_queue_work().
|
|
*/
|
|
|
|
static void os_area_queue_work_handler(struct work_struct *work)
|
|
{
|
|
struct device_node *node;
|
|
int error;
|
|
|
|
pr_debug(" -> %s:%d\n", __func__, __LINE__);
|
|
|
|
node = of_find_node_by_path("/");
|
|
if (node) {
|
|
os_area_set_property(node, &property_rtc_diff);
|
|
of_node_put(node);
|
|
} else
|
|
pr_debug("%s:%d of_find_node_by_path failed\n",
|
|
__func__, __LINE__);
|
|
|
|
error = update_flash_db();
|
|
if (error)
|
|
pr_warning("%s: Could not update FLASH ROM\n", __func__);
|
|
|
|
pr_debug(" <- %s:%d\n", __func__, __LINE__);
|
|
}
|
|
|
|
static void os_area_queue_work(void)
|
|
{
|
|
static DECLARE_WORK(q, os_area_queue_work_handler);
|
|
|
|
wmb();
|
|
schedule_work(&q);
|
|
}
|
|
|
|
/**
|
|
* ps3_os_area_save_params - Copy data from os area mirror to @saved_params.
|
|
*
|
|
* For the convenience of the guest the HV makes a copy of the os area in
|
|
* flash to a high address in the boot memory region and then puts that RAM
|
|
* address and the byte count into the repository for retrieval by the guest.
|
|
* We copy the data we want into a static variable and allow the memory setup
|
|
* by the HV to be claimed by the memblock manager.
|
|
*
|
|
* The os area mirror will not be available to a second stage kernel, and
|
|
* the header verify will fail. In this case, the saved_params values will
|
|
* be set from flash memory or the passed in device tree in ps3_os_area_init().
|
|
*/
|
|
|
|
void __init ps3_os_area_save_params(void)
|
|
{
|
|
int result;
|
|
u64 lpar_addr;
|
|
unsigned int size;
|
|
struct os_area_header *header;
|
|
struct os_area_params *params;
|
|
struct os_area_db *db;
|
|
|
|
pr_debug(" -> %s:%d\n", __func__, __LINE__);
|
|
|
|
result = ps3_repository_read_boot_dat_info(&lpar_addr, &size);
|
|
|
|
if (result) {
|
|
pr_debug("%s:%d ps3_repository_read_boot_dat_info failed\n",
|
|
__func__, __LINE__);
|
|
return;
|
|
}
|
|
|
|
header = (struct os_area_header *)__va(lpar_addr);
|
|
params = (struct os_area_params *)__va(lpar_addr
|
|
+ OS_AREA_SEGMENT_SIZE);
|
|
|
|
result = verify_header(header);
|
|
|
|
if (result) {
|
|
/* Second stage kernels exit here. */
|
|
pr_debug("%s:%d verify_header failed\n", __func__, __LINE__);
|
|
dump_header(header);
|
|
return;
|
|
}
|
|
|
|
db = (struct os_area_db *)__va(lpar_addr
|
|
+ header->db_area_offset * OS_AREA_SEGMENT_SIZE);
|
|
|
|
dump_header(header);
|
|
dump_params(params);
|
|
dump_db(db);
|
|
|
|
result = db_verify(db) || db_get_rtc_diff(db, &saved_params.rtc_diff);
|
|
if (result)
|
|
saved_params.rtc_diff = params->rtc_diff ? params->rtc_diff
|
|
: SECONDS_FROM_1970_TO_2000;
|
|
saved_params.av_multi_out = params->av_multi_out;
|
|
saved_params.valid = 1;
|
|
|
|
memset(header, 0, sizeof(*header));
|
|
|
|
pr_debug(" <- %s:%d\n", __func__, __LINE__);
|
|
}
|
|
|
|
/**
|
|
* ps3_os_area_init - Setup os area device tree properties as needed.
|
|
*/
|
|
|
|
void __init ps3_os_area_init(void)
|
|
{
|
|
struct device_node *node;
|
|
|
|
pr_debug(" -> %s:%d\n", __func__, __LINE__);
|
|
|
|
node = of_find_node_by_path("/");
|
|
|
|
if (!saved_params.valid && node) {
|
|
/* Second stage kernels should have a dt entry. */
|
|
os_area_get_property(node, &property_rtc_diff);
|
|
os_area_get_property(node, &property_av_multi_out);
|
|
}
|
|
|
|
if(!saved_params.rtc_diff)
|
|
saved_params.rtc_diff = SECONDS_FROM_1970_TO_2000;
|
|
|
|
if (node) {
|
|
os_area_set_property(node, &property_rtc_diff);
|
|
os_area_set_property(node, &property_av_multi_out);
|
|
of_node_put(node);
|
|
} else
|
|
pr_debug("%s:%d of_find_node_by_path failed\n",
|
|
__func__, __LINE__);
|
|
|
|
pr_debug(" <- %s:%d\n", __func__, __LINE__);
|
|
}
|
|
|
|
/**
|
|
* ps3_os_area_get_rtc_diff - Returns the rtc diff value.
|
|
*/
|
|
|
|
u64 ps3_os_area_get_rtc_diff(void)
|
|
{
|
|
return saved_params.rtc_diff;
|
|
}
|
|
EXPORT_SYMBOL_GPL(ps3_os_area_get_rtc_diff);
|
|
|
|
/**
|
|
* ps3_os_area_set_rtc_diff - Set the rtc diff value.
|
|
*
|
|
* An asynchronous write is needed to support writing updates from
|
|
* the timer interrupt context.
|
|
*/
|
|
|
|
void ps3_os_area_set_rtc_diff(u64 rtc_diff)
|
|
{
|
|
if (saved_params.rtc_diff != rtc_diff) {
|
|
saved_params.rtc_diff = rtc_diff;
|
|
os_area_queue_work();
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(ps3_os_area_set_rtc_diff);
|
|
|
|
/**
|
|
* ps3_os_area_get_av_multi_out - Returns the default video mode.
|
|
*/
|
|
|
|
enum ps3_param_av_multi_out ps3_os_area_get_av_multi_out(void)
|
|
{
|
|
return saved_params.av_multi_out;
|
|
}
|
|
EXPORT_SYMBOL_GPL(ps3_os_area_get_av_multi_out);
|