93 строки
2.4 KiB
C
93 строки
2.4 KiB
C
|
/*
|
||
|
|
* R-Car Gen1 RESET/WDT, R-Car Gen2, Gen3, and RZ/G RST Driver
|
||
|
|
*
|
||
|
|
* Copyright (C) 2016 Glider bvba
|
||
|
|
*
|
||
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
||
|
|
* License. See the file "COPYING" in the main directory of this archive
|
||
|
|
* for more details.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/err.h>
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <linux/of_address.h>
|
||
|
|
#include <linux/soc/renesas/rcar-rst.h>
|
||
|
|
|
||
|
|
struct rst_config {
|
||
|
|
unsigned int modemr; /* Mode Monitoring Register Offset */
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct rst_config rcar_rst_gen1 __initconst = {
|
||
|
|
.modemr = 0x20,
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct rst_config rcar_rst_gen2 __initconst = {
|
||
|
|
.modemr = 0x60,
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct of_device_id rcar_rst_matches[] __initconst = {
|
||
|
|
/* RZ/G is handled like R-Car Gen2 */
|
||
|
|
{ .compatible = "renesas,r8a7743-rst", .data = &rcar_rst_gen2 },
|
||
|
|
{ .compatible = "renesas,r8a7745-rst", .data = &rcar_rst_gen2 },
|
||
|
|
/* R-Car Gen1 */
|
||
|
|
{ .compatible = "renesas,r8a7778-reset-wdt", .data = &rcar_rst_gen1 },
|
||
|
|
{ .compatible = "renesas,r8a7779-reset-wdt", .data = &rcar_rst_gen1 },
|
||
|
|
/* R-Car Gen2 */
|
||
|
|
{ .compatible = "renesas,r8a7790-rst", .data = &rcar_rst_gen2 },
|
||
|
|
{ .compatible = "renesas,r8a7791-rst", .data = &rcar_rst_gen2 },
|
||
|
|
{ .compatible = "renesas,r8a7792-rst", .data = &rcar_rst_gen2 },
|
||
|
|
{ .compatible = "renesas,r8a7793-rst", .data = &rcar_rst_gen2 },
|
||
|
|
{ .compatible = "renesas,r8a7794-rst", .data = &rcar_rst_gen2 },
|
||
|
|
/* R-Car Gen3 is handled like R-Car Gen2 */
|
||
|
|
{ .compatible = "renesas,r8a7795-rst", .data = &rcar_rst_gen2 },
|
||
|
|
{ .compatible = "renesas,r8a7796-rst", .data = &rcar_rst_gen2 },
|
||
|
|
{ /* sentinel */ }
|
||
|
|
};
|
||
|
|
|
||
|
|
static void __iomem *rcar_rst_base __initdata;
|
||
|
|
static u32 saved_mode __initdata;
|
||
|
|
|
||
|
|
static int __init rcar_rst_init(void)
|
||
|
|
{
|
||
|
|
const struct of_device_id *match;
|
||
|
|
const struct rst_config *cfg;
|
||
|
|
struct device_node *np;
|
||
|
|
void __iomem *base;
|
||
|
|
int error = 0;
|
||
|
|
|
||
|
|
np = of_find_matching_node_and_match(NULL, rcar_rst_matches, &match);
|
||
|
|
if (!np)
|
||
|
|
return -ENODEV;
|
||
|
|
|
||
|
|
base = of_iomap(np, 0);
|
||
|
|
if (!base) {
|
||
|
|
pr_warn("%s: Cannot map regs\n", np->full_name);
|
||
|
|
error = -ENOMEM;
|
||
|
|
goto out_put;
|
||
|
|
}
|
||
|
|
|
||
|
|
rcar_rst_base = base;
|
||
|
|
cfg = match->data;
|
||
|
|
saved_mode = ioread32(base + cfg->modemr);
|
||
|
|
|
||
|
|
pr_debug("%s: MODE = 0x%08x\n", np->full_name, saved_mode);
|
||
|
|
|
||
|
|
out_put:
|
||
|
|
of_node_put(np);
|
||
|
|
return error;
|
||
|
|
}
|
||
|
|
|
||
|
|
int __init rcar_rst_read_mode_pins(u32 *mode)
|
||
|
|
{
|
||
|
|
int error;
|
||
|
|
|
||
|
|
if (!rcar_rst_base) {
|
||
|
|
error = rcar_rst_init();
|
||
|
|
if (error)
|
||
|
|
return error;
|
||
|
|
}
|
||
|
|
|
||
|
|
*mode = saved_mode;
|
||
|
|
return 0;
|
||
|
|
}
|