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
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
|
/*
* arch/arm/mach-ns9xxx/processor-ns9360.c
*
* Copyright (C) 2007,2008 by Digi International Inc.
* All rights reserved.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms of the GNU General Public License version 2 as published by
* the Free Software Foundation.
*/
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <asm/page.h>
#include <asm/mach/map.h>
#include <mach/regs-sys-ns9360.h>
#include "clock.h"
#include "processor-ns9360.h"
#include "gpiolib-ns9360.h"
void ns9360_reset(char mode)
{
u32 reg;
reg = __raw_readl(SYS_PLL) >> 16;
REGSET(reg, SYS_PLL, SWC, YES);
__raw_writel(reg, SYS_PLL);
}
#define CRYSTAL 29491200 /* Hz */
unsigned long ns9360_systemclock(void)
{
u32 pll = __raw_readl(SYS_PLL);
return CRYSTAL * (REGGETIM(pll, SYS_PLL, ND) + 1)
>> REGGETIM(pll, SYS_PLL, FS);
}
unsigned long ns9360_cpuclock(void)
{
return ns9360_systemclock() / 2;
}
unsigned long ns9360_ahbclock(void)
{
return ns9360_systemclock() / 4;
}
static unsigned long ns9360_get_systemclock_rate(struct clk *clk)
{
return ns9360_systemclock();
}
static unsigned long ns9360_get_bbusclock_rate(struct clk *clk)
{
return ns9360_systemclock() / 8;
}
static unsigned long ns9360_get_cpuclock_rate(struct clk *clk)
{
return ns9360_cpuclock();
}
static unsigned long ns9360_get_ahbclock_rate(struct clk *clk)
{
return ns9360_ahbclock();
}
static struct map_desc ns9360_io_desc[] __initdata = {
{ /* BBus */
.virtual = io_p2v(0x90000000),
.pfn = __phys_to_pfn(0x90000000),
.length = 0x00700000,
.type = MT_DEVICE,
}, { /* AHB */
.virtual = io_p2v(0xa0100000),
.pfn = __phys_to_pfn(0xa0100000),
.length = 0x00900000,
.type = MT_DEVICE,
},
};
void __init ns9360_map_io(void)
{
iotable_init(ns9360_io_desc, ARRAY_SIZE(ns9360_io_desc));
}
void ns9360_init_machine(void)
{
/* register system, bbus and cpu clocks */
struct clk *clk = kzalloc(4 * sizeof(*clk), GFP_KERNEL);
int ret, i;
if (!clk) {
pr_warning("%s: could not register system clocks\n", __func__);
return;
}
clk[0].name = "systemclock";
clk[0].get_rate = ns9360_get_systemclock_rate;
clk[1].name = "bbusclock";
clk[1].get_rate = ns9360_get_bbusclock_rate;
clk[2].name = "cpuclock";
clk[2].get_rate = ns9360_get_cpuclock_rate;
clk[3].name = "ahbclock";
clk[3].get_rate = ns9360_get_ahbclock_rate;
for (i = 0; i < 4; ++i) {
clk[i].id = -1;
ret = clk_register(&clk[i]);
if (ret)
pr_warning("%s: could not register %s\n",
__func__, clk[i].name);
}
/* add system GPIOs */
ns9360_gpio_init();
}
|
