Root/target/linux/mpc83xx/patches-2.6.33/017-platforms_83xx_rbppc.patch

1--- a/arch/powerpc/platforms/83xx/rbppc.c
2+++ b/arch/powerpc/platforms/83xx/rbppc.c
3@@ -0,0 +1,316 @@
4+/*
5+ * Copyright (C) 2008-2009 Noah Fontes <nfontes@transtruct.org>
6+ * Copyright (C) 2009 Michael Guntsche <mike@it-loops.com>
7+ * Copyright (C) Mikrotik 2007
8+ *
9+ * This program is free software; you can redistribute it and/or modify it
10+ * under the terms of the GNU General Public License as published by the
11+ * Free Software Foundation; either version 2 of the License, or (at your
12+ * option) any later version.
13+ */
14+
15+#include <linux/delay.h>
16+#include <linux/root_dev.h>
17+#include <linux/initrd.h>
18+#include <linux/interrupt.h>
19+#include <linux/of_platform.h>
20+#include <linux/of_device.h>
21+#include <linux/of_platform.h>
22+#include <asm/time.h>
23+#include <asm/ipic.h>
24+#include <asm/udbg.h>
25+#include <asm/qe.h>
26+#include <asm/qe_ic.h>
27+#include <sysdev/fsl_soc.h>
28+#include <sysdev/fsl_pci.h>
29+#include "mpc83xx.h"
30+
31+#define SYSCTL 0x100
32+#define SICRL 0x014
33+
34+#define GTCFR2 0x04
35+#define GTMDR4 0x22
36+#define GTRFR4 0x26
37+#define GTCNR4 0x2e
38+#define GTVER4 0x36
39+#define GTPSR4 0x3e
40+
41+#define GTCFR_BCM 0x40
42+#define GTCFR_STP4 0x20
43+#define GTCFR_RST4 0x10
44+#define GTCFR_STP3 0x02
45+#define GTCFR_RST3 0x01
46+
47+#define GTMDR_ORI 0x10
48+#define GTMDR_FRR 0x08
49+#define GTMDR_ICLK16 0x04
50+
51+extern int par_io_data_set(u8 port, u8 pin, u8 val);
52+extern int par_io_config_pin(u8 port, u8 pin, int dir, int open_drain,
53+ int assignment, int has_irq);
54+
55+static unsigned timer_freq;
56+static void *gtm;
57+
58+static int beeper_irq;
59+static unsigned beeper_gpio_pin[2];
60+
61+irqreturn_t rbppc_timer_irq(int irq, void *ptr)
62+{
63+ static int toggle = 0;
64+
65+ par_io_data_set(beeper_gpio_pin[0], beeper_gpio_pin[1], toggle);
66+ toggle = !toggle;
67+
68+ /* ack interrupt */
69+ out_be16(gtm + GTVER4, 3);
70+
71+ return IRQ_HANDLED;
72+}
73+
74+void rbppc_beep(unsigned freq)
75+{
76+ unsigned gtmdr;
77+
78+ if (freq > 5000) freq = 5000;
79+
80+ if (!gtm)
81+ return;
82+ if (!freq) {
83+ out_8(gtm + GTCFR2, GTCFR_STP4 | GTCFR_STP3);
84+ return;
85+ }
86+
87+ out_8(gtm + GTCFR2, GTCFR_RST4 | GTCFR_STP3);
88+ out_be16(gtm + GTPSR4, 255);
89+ gtmdr = GTMDR_FRR | GTMDR_ICLK16;
90+ if (beeper_irq != NO_IRQ) gtmdr |= GTMDR_ORI;
91+ out_be16(gtm + GTMDR4, gtmdr);
92+ out_be16(gtm + GTVER4, 3);
93+
94+ out_be16(gtm + GTRFR4, timer_freq / 16 / 256 / freq / 2);
95+ out_be16(gtm + GTCNR4, 0);
96+}
97+EXPORT_SYMBOL(rbppc_beep);
98+
99+static void __init rbppc_setup_arch(void)
100+{
101+ struct device_node *np;
102+
103+ np = of_find_node_by_type(NULL, "cpu");
104+ if (np) {
105+ const unsigned *fp = of_get_property(np, "clock-frequency", NULL);
106+ loops_per_jiffy = fp ? *fp / HZ : 0;
107+
108+ of_node_put(np);
109+ }
110+
111+ np = of_find_node_by_name(NULL, "serial");
112+ if (np) {
113+ timer_freq =
114+ *(unsigned *) of_get_property(np, "clock-frequency", NULL);
115+ of_node_put(np);
116+ }
117+
118+#ifdef CONFIG_PCI
119+ np = of_find_node_by_type(NULL, "pci");
120+ if (np) {
121+ mpc83xx_add_bridge(np);
122+ }
123+#endif
124+
125+#ifdef CONFIG_QUICC_ENGINE
126+ np = of_find_node_by_name(np, "par_io");
127+ if (np) {
128+ qe_reset();
129+ par_io_init(np);
130+ of_node_put(np);
131+
132+ np = NULL;
133+ while (1) {
134+ np = of_find_node_by_name(np, "ucc");
135+ if (!np) break;
136+
137+ par_io_of_config(np);
138+ }
139+ }
140+#endif
141+
142+}
143+
144+void __init rbppc_init_IRQ(void)
145+{
146+ struct device_node *np;
147+
148+ np = of_find_node_by_type(NULL, "ipic");
149+ if (np) {
150+ ipic_init(np, 0);
151+ ipic_set_default_priority();
152+ of_node_put(np);
153+ }
154+
155+#ifdef CONFIG_QUICC_ENGINE
156+ np = of_find_node_by_type(NULL, "qeic");
157+ if (np) {
158+ qe_ic_init(np, 0, qe_ic_cascade_low_ipic, qe_ic_cascade_high_ipic);
159+ of_node_put(np);
160+ }
161+#endif
162+}
163+
164+static int __init rbppc_probe(void)
165+{
166+ char *model;
167+
168+ model = of_get_flat_dt_prop(of_get_flat_dt_root(), "model", NULL);
169+
170+ if (!model)
171+ return 0;
172+
173+ if (strcmp(model, "RB600") == 0)
174+ return 1;
175+
176+ return 0;
177+}
178+
179+static void __init rbppc_beeper_init(struct device_node *beeper)
180+{
181+ struct resource res;
182+ struct device_node *gpio;
183+ const unsigned *pin;
184+ const unsigned *gpio_id;
185+
186+ if (of_address_to_resource(beeper, 0, &res)) {
187+ printk(KERN_ERR "rbppc_beeper_init(%s): Beeper error: No region specified\n", beeper->full_name);
188+ return;
189+ }
190+
191+ pin = of_get_property(beeper, "gpio", NULL);
192+ if (pin) {
193+ gpio = of_find_node_by_phandle(pin[0]);
194+
195+ if (!gpio) {
196+ printk(KERN_ERR "rbppc_beeper_init(%s): Beeper error: GPIO handle %x not found\n", beeper->full_name, pin[0]);
197+ return;
198+ }
199+
200+ gpio_id = of_get_property(gpio, "device-id", NULL);
201+ if (!gpio_id) {
202+ printk(KERN_ERR "rbppc_beeper_init(%s): Beeper error: No device-id specified in GPIO\n", beeper->full_name);
203+ return;
204+ }
205+
206+ beeper_gpio_pin[0] = *gpio_id;
207+ beeper_gpio_pin[1] = pin[1];
208+
209+ par_io_config_pin(*gpio_id, pin[1], 1, 0, 0, 0);
210+ } else {
211+ void *sysctl;
212+
213+ sysctl = ioremap_nocache(get_immrbase() + SYSCTL, 0x100);
214+ out_be32(sysctl + SICRL,
215+ in_be32(sysctl + SICRL) | (1 << (31 - 19)));
216+ iounmap(sysctl);
217+ }
218+
219+ gtm = ioremap_nocache(res.start, res.end - res.start + 1);
220+
221+ beeper_irq = irq_of_parse_and_map(beeper, 0);
222+ if (beeper_irq != NO_IRQ) {
223+ int e = request_irq(beeper_irq, rbppc_timer_irq, 0, "beeper", NULL);
224+ if (e) {
225+ printk(KERN_ERR "rbppc_beeper_init(%s): Request of beeper irq failed!\n", beeper->full_name);
226+ }
227+ }
228+}
229+
230+#define SBIT(x) (0x80000000 >> (x))
231+#define DBIT(x, y) ((y) << (32 - (((x % 16) + 1) * 2)))
232+
233+#define SICRL_RB600(x) ((x) + (0x114 >> 2))
234+#define GPIO_DIR_RB600(x) ((x) + (0xc00 >> 2))
235+#define GPIO_DATA_RB600(x) ((x) + (0xc08 >> 2))
236+
237+static void rbppc_restart(char *cmd)
238+{
239+ __be32 __iomem *reg;
240+
241+ reg = ioremap(get_immrbase(), 0x1000);
242+ local_irq_disable();
243+ out_be32(SICRL_RB600(reg), in_be32(SICRL_RB600(reg)) & ~0x00800000);
244+ out_be32(GPIO_DIR_RB600(reg), in_be32(GPIO_DIR_RB600(reg)) | SBIT(2));
245+ out_be32(GPIO_DATA_RB600(reg), in_be32(GPIO_DATA_RB600(reg)) & ~SBIT(2));
246+
247+ while (1);
248+}
249+
250+static void rbppc_halt(void)
251+{
252+ while (1);
253+}
254+
255+static struct of_device_id rbppc_ids[] = {
256+ { .type = "soc", },
257+ { .compatible = "soc", },
258+ { .compatible = "simple-bus", },
259+ { .compatible = "gianfar", },
260+ { },
261+};
262+
263+static int __init rbppc_declare_of_platform_devices(void)
264+{
265+ struct device_node *np;
266+ unsigned idx;
267+
268+ of_platform_bus_probe(NULL, rbppc_ids, NULL);
269+
270+ np = of_find_node_by_type(NULL, "mdio");
271+ if (np) {
272+ unsigned len;
273+ unsigned *res;
274+ const unsigned *eres;
275+ struct device_node *ep;
276+
277+ ep = of_find_compatible_node(NULL, "network", "ucc_geth");
278+ if (ep) {
279+ eres = of_get_property(ep, "reg", &len);
280+ res = (unsigned *) of_get_property(np, "reg", &len);
281+ if (res && eres) {
282+ res[0] = eres[0] + 0x120;
283+ }
284+ }
285+ }
286+
287+ np = of_find_node_by_name(NULL, "nand");
288+ if (np) {
289+ of_platform_device_create(np, "nand", NULL);
290+ }
291+
292+ idx = 0;
293+ for_each_node_by_type(np, "rb,cf") {
294+ char dev_name[12];
295+ snprintf(dev_name, sizeof(dev_name), "cf.%u", idx);
296+ of_platform_device_create(np, dev_name, NULL);
297+ ++idx;
298+ }
299+
300+ np = of_find_node_by_name(NULL, "beeper");
301+ if (np) {
302+ rbppc_beeper_init(np);
303+ }
304+
305+ return 0;
306+}
307+device_initcall(rbppc_declare_of_platform_devices);
308+
309+define_machine(rb600) {
310+ .name = "MikroTik RouterBOARD 600 series",
311+ .probe = rbppc_probe,
312+ .setup_arch = rbppc_setup_arch,
313+ .init_IRQ = rbppc_init_IRQ,
314+ .get_irq = ipic_get_irq,
315+ .restart = rbppc_restart,
316+ .halt = rbppc_halt,
317+ .time_init = mpc83xx_time_init,
318+ .calibrate_decr = generic_calibrate_decr,
319+};
320

Archive Download this file

Branches:
backfire
history
master
release_2010-11-17
release_2010-12-14
release_2011-02-23
release_2011-05-28
release_2011-08-27
release_2011-11-13
release_2012-03-18
release_2012-04-09
release_2012-10-11
uclibc_nptl



interactive