blob: b0124b700cb3d1e3bf35ae0919f44a203bcc2687 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
|
/*
* Copyright (C) 2010 B Labs Ltd,
* http://l4dev.org
* Author: Alexey Zaytsev <alexey.zaytsev@gmail.com>
*
* Based on mach-nomadik
* Copyright (C) 2009 Jean-Christophe PLAGNIOL-VILLARD <plagnio@jcrosoft.com>
*
* Copyright (C) 1999 - 2003 ARM Limited
* Copyright (C) 2000 Deep Blue Solutions Ltd
*
* 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.
*
*
*/
#include <common.h>
#include <init.h>
#include <clock.h>
#include <debug_ll.h>
#include <restart.h>
#include <linux/sizes.h>
#include <linux/clkdev.h>
#include <linux/clk.h>
#include <linux/err.h>
#include <linux/amba/bus.h>
#include <io.h>
#include <asm/armlinux.h>
#include <mach/versatile/platform.h>
static void __noreturn versatile_reset_soc(struct restart_handler *rst)
{
u32 val;
val = __raw_readl(VERSATILE_SYS_RESETCTL) & ~0x7;
val |= 0x105;
__raw_writel(0xa05f, VERSATILE_SYS_LOCK);
__raw_writel(val, VERSATILE_SYS_RESETCTL);
__raw_writel(0, VERSATILE_SYS_LOCK);
hang();
}
static int versatile_init(void)
{
if (!of_machine_is_compatible("arm,versatile-pb") &&
!of_machine_is_compatible("arm,versatile-ab"))
return 0;
restart_handler_register_fn("soc", versatile_reset_soc);
return 0;
}
core_initcall(versatile_init);
|