forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
159 lines
4.1 KiB
159 lines
4.1 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* Copyright (C) 2014 Linaro Ltd. |
|
* |
|
* Author: Linus Walleij <[email protected]> |
|
*/ |
|
#include <linux/init.h> |
|
#include <linux/mfd/syscon.h> |
|
#include <linux/reboot.h> |
|
#include <linux/regmap.h> |
|
#include <linux/of.h> |
|
|
|
#define INTEGRATOR_HDR_CTRL_OFFSET 0x0C |
|
#define INTEGRATOR_HDR_LOCK_OFFSET 0x14 |
|
#define INTEGRATOR_CM_CTRL_RESET (1 << 3) |
|
|
|
#define VERSATILE_SYS_LOCK_OFFSET 0x20 |
|
#define VERSATILE_SYS_RESETCTL_OFFSET 0x40 |
|
|
|
/* Magic unlocking token used on all Versatile boards */ |
|
#define VERSATILE_LOCK_VAL 0xA05F |
|
|
|
/* |
|
* We detect the different syscon types from the compatible strings. |
|
*/ |
|
enum versatile_reboot { |
|
INTEGRATOR_REBOOT_CM, |
|
VERSATILE_REBOOT_CM, |
|
REALVIEW_REBOOT_EB, |
|
REALVIEW_REBOOT_PB1176, |
|
REALVIEW_REBOOT_PB11MP, |
|
REALVIEW_REBOOT_PBA8, |
|
REALVIEW_REBOOT_PBX, |
|
}; |
|
|
|
/* Pointer to the system controller */ |
|
static struct regmap *syscon_regmap; |
|
static enum versatile_reboot versatile_reboot_type; |
|
|
|
static const struct of_device_id versatile_reboot_of_match[] = { |
|
{ |
|
.compatible = "arm,core-module-integrator", |
|
.data = (void *)INTEGRATOR_REBOOT_CM |
|
}, |
|
{ |
|
.compatible = "arm,core-module-versatile", |
|
.data = (void *)VERSATILE_REBOOT_CM, |
|
}, |
|
{ |
|
.compatible = "arm,realview-eb-syscon", |
|
.data = (void *)REALVIEW_REBOOT_EB, |
|
}, |
|
{ |
|
.compatible = "arm,realview-pb1176-syscon", |
|
.data = (void *)REALVIEW_REBOOT_PB1176, |
|
}, |
|
{ |
|
.compatible = "arm,realview-pb11mp-syscon", |
|
.data = (void *)REALVIEW_REBOOT_PB11MP, |
|
}, |
|
{ |
|
.compatible = "arm,realview-pba8-syscon", |
|
.data = (void *)REALVIEW_REBOOT_PBA8, |
|
}, |
|
{ |
|
.compatible = "arm,realview-pbx-syscon", |
|
.data = (void *)REALVIEW_REBOOT_PBX, |
|
}, |
|
{}, |
|
}; |
|
|
|
static int versatile_reboot(struct notifier_block *this, unsigned long mode, |
|
void *cmd) |
|
{ |
|
/* Unlock the reset register */ |
|
/* Then hit reset on the different machines */ |
|
switch (versatile_reboot_type) { |
|
case INTEGRATOR_REBOOT_CM: |
|
regmap_write(syscon_regmap, INTEGRATOR_HDR_LOCK_OFFSET, |
|
VERSATILE_LOCK_VAL); |
|
regmap_update_bits(syscon_regmap, |
|
INTEGRATOR_HDR_CTRL_OFFSET, |
|
INTEGRATOR_CM_CTRL_RESET, |
|
INTEGRATOR_CM_CTRL_RESET); |
|
break; |
|
case VERSATILE_REBOOT_CM: |
|
regmap_write(syscon_regmap, VERSATILE_SYS_LOCK_OFFSET, |
|
VERSATILE_LOCK_VAL); |
|
regmap_update_bits(syscon_regmap, |
|
VERSATILE_SYS_RESETCTL_OFFSET, |
|
0x0107, |
|
0x0105); |
|
regmap_write(syscon_regmap, VERSATILE_SYS_LOCK_OFFSET, |
|
0); |
|
break; |
|
case REALVIEW_REBOOT_EB: |
|
regmap_write(syscon_regmap, VERSATILE_SYS_LOCK_OFFSET, |
|
VERSATILE_LOCK_VAL); |
|
regmap_write(syscon_regmap, |
|
VERSATILE_SYS_RESETCTL_OFFSET, 0x0008); |
|
break; |
|
case REALVIEW_REBOOT_PB1176: |
|
regmap_write(syscon_regmap, VERSATILE_SYS_LOCK_OFFSET, |
|
VERSATILE_LOCK_VAL); |
|
regmap_write(syscon_regmap, |
|
VERSATILE_SYS_RESETCTL_OFFSET, 0x0100); |
|
break; |
|
case REALVIEW_REBOOT_PB11MP: |
|
case REALVIEW_REBOOT_PBA8: |
|
regmap_write(syscon_regmap, VERSATILE_SYS_LOCK_OFFSET, |
|
VERSATILE_LOCK_VAL); |
|
regmap_write(syscon_regmap, VERSATILE_SYS_RESETCTL_OFFSET, |
|
0x0000); |
|
regmap_write(syscon_regmap, VERSATILE_SYS_RESETCTL_OFFSET, |
|
0x0004); |
|
break; |
|
case REALVIEW_REBOOT_PBX: |
|
regmap_write(syscon_regmap, VERSATILE_SYS_LOCK_OFFSET, |
|
VERSATILE_LOCK_VAL); |
|
regmap_write(syscon_regmap, VERSATILE_SYS_RESETCTL_OFFSET, |
|
0x00f0); |
|
regmap_write(syscon_regmap, VERSATILE_SYS_RESETCTL_OFFSET, |
|
0x00f4); |
|
break; |
|
} |
|
dsb(); |
|
|
|
return NOTIFY_DONE; |
|
} |
|
|
|
static struct notifier_block versatile_reboot_nb = { |
|
.notifier_call = versatile_reboot, |
|
.priority = 192, |
|
}; |
|
|
|
static int __init versatile_reboot_probe(void) |
|
{ |
|
const struct of_device_id *reboot_id; |
|
struct device_node *np; |
|
int err; |
|
|
|
np = of_find_matching_node_and_match(NULL, versatile_reboot_of_match, |
|
&reboot_id); |
|
if (!np) |
|
return -ENODEV; |
|
versatile_reboot_type = (enum versatile_reboot)reboot_id->data; |
|
|
|
syscon_regmap = syscon_node_to_regmap(np); |
|
if (IS_ERR(syscon_regmap)) |
|
return PTR_ERR(syscon_regmap); |
|
|
|
err = register_restart_handler(&versatile_reboot_nb); |
|
if (err) |
|
return err; |
|
|
|
pr_info("versatile reboot driver registered\n"); |
|
return 0; |
|
} |
|
device_initcall(versatile_reboot_probe);
|
|
|