airport: remove useless return in a function returning void
[linux/fpc-iii.git] / arch / powerpc / platforms / 52xx / lite5200.c
blob6d584f4e3c9a1032b98e22e8f96cb91900158edf
1 /*
2 * Freescale Lite5200 board support
4 * Written by: Grant Likely <grant.likely@secretlab.ca>
6 * Copyright (C) Secret Lab Technologies Ltd. 2006. All rights reserved.
7 * Copyright (C) Freescale Semicondutor, Inc. 2006. All rights reserved.
9 * Description:
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
16 #undef DEBUG
18 #include <linux/init.h>
19 #include <linux/pci.h>
20 #include <linux/of.h>
21 #include <linux/root_dev.h>
22 #include <linux/initrd.h>
23 #include <asm/time.h>
24 #include <asm/io.h>
25 #include <asm/machdep.h>
26 #include <asm/prom.h>
27 #include <asm/mpc52xx.h>
29 /* ************************************************************************
31 * Setup the architecture
35 /* mpc5200 device tree match tables */
36 static struct of_device_id mpc5200_cdm_ids[] __initdata = {
37 { .compatible = "fsl,mpc5200-cdm", },
38 { .compatible = "mpc5200-cdm", },
42 static struct of_device_id mpc5200_gpio_ids[] __initdata = {
43 { .compatible = "fsl,mpc5200-gpio", },
44 { .compatible = "mpc5200-gpio", },
49 * Fix clock configuration.
51 * Firmware is supposed to be responsible for this. If you are creating a
52 * new board port, do *NOT* duplicate this code. Fix your boot firmware
53 * to set it correctly in the first place
55 static void __init
56 lite5200_fix_clock_config(void)
58 struct device_node *np;
59 struct mpc52xx_cdm __iomem *cdm;
60 /* Map zones */
61 np = of_find_matching_node(NULL, mpc5200_cdm_ids);
62 cdm = of_iomap(np, 0);
63 of_node_put(np);
64 if (!cdm) {
65 printk(KERN_ERR "%s() failed; expect abnormal behaviour\n",
66 __func__);
67 return;
70 /* Use internal 48 Mhz */
71 out_8(&cdm->ext_48mhz_en, 0x00);
72 out_8(&cdm->fd_enable, 0x01);
73 if (in_be32(&cdm->rstcfg) & 0x40) /* Assumes 33Mhz clock */
74 out_be16(&cdm->fd_counters, 0x0001);
75 else
76 out_be16(&cdm->fd_counters, 0x5555);
78 /* Unmap the regs */
79 iounmap(cdm);
83 * Fix setting of port_config register.
85 * Firmware is supposed to be responsible for this. If you are creating a
86 * new board port, do *NOT* duplicate this code. Fix your boot firmware
87 * to set it correctly in the first place
89 static void __init
90 lite5200_fix_port_config(void)
92 struct device_node *np;
93 struct mpc52xx_gpio __iomem *gpio;
94 u32 port_config;
96 np = of_find_matching_node(NULL, mpc5200_gpio_ids);
97 gpio = of_iomap(np, 0);
98 of_node_put(np);
99 if (!gpio) {
100 printk(KERN_ERR "%s() failed. expect abnormal behavior\n",
101 __func__);
102 return;
105 /* Set port config */
106 port_config = in_be32(&gpio->port_config);
108 port_config &= ~0x00800000; /* 48Mhz internal, pin is GPIO */
110 port_config &= ~0x00007000; /* USB port : Differential mode */
111 port_config |= 0x00001000; /* USB 1 only */
113 port_config &= ~0x03000000; /* ATA CS is on csb_4/5 */
114 port_config |= 0x01000000;
116 pr_debug("port_config: old:%x new:%x\n",
117 in_be32(&gpio->port_config), port_config);
118 out_be32(&gpio->port_config, port_config);
120 /* Unmap zone */
121 iounmap(gpio);
124 #ifdef CONFIG_PM
125 static void lite5200_suspend_prepare(void __iomem *mbar)
127 u8 pin = 1; /* GPIO_WKUP_1 (GPIO_PSC2_4) */
128 u8 level = 0; /* wakeup on low level */
129 mpc52xx_set_wakeup_gpio(pin, level);
132 * power down usb port
133 * this needs to be called before of-ohci suspend code
136 /* set ports to "power switched" and "powered at the same time"
137 * USB Rh descriptor A: NPS = 0, PSM = 0 */
138 out_be32(mbar + 0x1048, in_be32(mbar + 0x1048) & ~0x300);
139 /* USB Rh status: LPS = 1 - turn off power */
140 out_be32(mbar + 0x1050, 0x00000001);
143 static void lite5200_resume_finish(void __iomem *mbar)
145 /* USB Rh status: LPSC = 1 - turn on power */
146 out_be32(mbar + 0x1050, 0x00010000);
148 #endif
150 static void __init lite5200_setup_arch(void)
152 if (ppc_md.progress)
153 ppc_md.progress("lite5200_setup_arch()", 0);
155 /* Map important registers from the internal memory map */
156 mpc52xx_map_common_devices();
158 /* Some mpc5200 & mpc5200b related configuration */
159 mpc5200_setup_xlb_arbiter();
161 /* Fix things that firmware should have done. */
162 lite5200_fix_clock_config();
163 lite5200_fix_port_config();
165 #ifdef CONFIG_PM
166 mpc52xx_suspend.board_suspend_prepare = lite5200_suspend_prepare;
167 mpc52xx_suspend.board_resume_finish = lite5200_resume_finish;
168 lite5200_pm_init();
169 #endif
171 mpc52xx_setup_pci();
175 * Called very early, MMU is off, device-tree isn't unflattened
177 static int __init lite5200_probe(void)
179 unsigned long node = of_get_flat_dt_root();
180 const char *model = of_get_flat_dt_prop(node, "model", NULL);
182 if (!of_flat_dt_is_compatible(node, "fsl,lite5200") &&
183 !of_flat_dt_is_compatible(node, "fsl,lite5200b"))
184 return 0;
185 pr_debug("%s board found\n", model ? model : "unknown");
187 return 1;
190 define_machine(lite5200) {
191 .name = "lite5200",
192 .probe = lite5200_probe,
193 .setup_arch = lite5200_setup_arch,
194 .init = mpc52xx_declare_of_platform_devices,
195 .init_IRQ = mpc52xx_init_irq,
196 .get_irq = mpc52xx_get_irq,
197 .restart = mpc52xx_restart,
198 .calibrate_decr = generic_calibrate_decr,