1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/pci.h>
18#include <linux/interrupt.h>
19#include <linux/spi/spi.h>
20#include <linux/spi/mmc_spi.h>
21#include <linux/mmc/host.h>
22#include <linux/of_platform.h>
23#include <linux/fsl_devices.h>
24
25#include <asm/time.h>
26#include <asm/ipic.h>
27#include <asm/udbg.h>
28#include <soc/fsl/qe/qe.h>
29#include <soc/fsl/qe/qe_ic.h>
30#include <sysdev/fsl_soc.h>
31#include <sysdev/fsl_pci.h>
32
33#include "mpc83xx.h"
34
35#undef DEBUG
36#ifdef DEBUG
37#define DBG(fmt...) udbg_printf(fmt)
38#else
39#define DBG(fmt...)
40#endif
41
42#ifdef CONFIG_QUICC_ENGINE
43static int __init of_fsl_spi_probe(char *type, char *compatible, u32 sysclk,
44 struct spi_board_info *board_infos,
45 unsigned int num_board_infos,
46 void (*cs_control)(struct spi_device *dev,
47 bool on))
48{
49 struct device_node *np;
50 unsigned int i = 0;
51
52 for_each_compatible_node(np, type, compatible) {
53 int ret;
54 unsigned int j;
55 const void *prop;
56 struct resource res[2];
57 struct platform_device *pdev;
58 struct fsl_spi_platform_data pdata = {
59 .cs_control = cs_control,
60 };
61
62 memset(res, 0, sizeof(res));
63
64 pdata.sysclk = sysclk;
65
66 prop = of_get_property(np, "reg", NULL);
67 if (!prop)
68 goto err;
69 pdata.bus_num = *(u32 *)prop;
70
71 prop = of_get_property(np, "cell-index", NULL);
72 if (prop)
73 i = *(u32 *)prop;
74
75 prop = of_get_property(np, "mode", NULL);
76 if (prop && !strcmp(prop, "cpu-qe"))
77 pdata.flags = SPI_QE_CPU_MODE;
78
79 for (j = 0; j < num_board_infos; j++) {
80 if (board_infos[j].bus_num == pdata.bus_num)
81 pdata.max_chipselect++;
82 }
83
84 if (!pdata.max_chipselect)
85 continue;
86
87 ret = of_address_to_resource(np, 0, &res[0]);
88 if (ret)
89 goto err;
90
91 ret = of_irq_to_resource(np, 0, &res[1]);
92 if (ret <= 0)
93 goto err;
94
95 pdev = platform_device_alloc("mpc83xx_spi", i);
96 if (!pdev)
97 goto err;
98
99 ret = platform_device_add_data(pdev, &pdata, sizeof(pdata));
100 if (ret)
101 goto unreg;
102
103 ret = platform_device_add_resources(pdev, res,
104 ARRAY_SIZE(res));
105 if (ret)
106 goto unreg;
107
108 ret = platform_device_add(pdev);
109 if (ret)
110 goto unreg;
111
112 goto next;
113unreg:
114 platform_device_del(pdev);
115err:
116 pr_err("%pOF: registration failed\n", np);
117next:
118 i++;
119 }
120
121 return i;
122}
123
124static int __init fsl_spi_init(struct spi_board_info *board_infos,
125 unsigned int num_board_infos,
126 void (*cs_control)(struct spi_device *spi,
127 bool on))
128{
129 u32 sysclk = -1;
130 int ret;
131
132
133 sysclk = get_brgfreq();
134 if (sysclk == -1) {
135 sysclk = fsl_get_sys_freq();
136 if (sysclk == -1)
137 return -ENODEV;
138 }
139
140 ret = of_fsl_spi_probe(NULL, "fsl,spi", sysclk, board_infos,
141 num_board_infos, cs_control);
142 if (!ret)
143 of_fsl_spi_probe("spi", "fsl_spi", sysclk, board_infos,
144 num_board_infos, cs_control);
145
146 return spi_register_board_info(board_infos, num_board_infos);
147}
148
149static void mpc83xx_spi_cs_control(struct spi_device *spi, bool on)
150{
151 pr_debug("%s %d %d\n", __func__, spi->chip_select, on);
152 par_io_data_set(3, 13, on);
153}
154
155static struct mmc_spi_platform_data mpc832x_mmc_pdata = {
156 .ocr_mask = MMC_VDD_33_34,
157};
158
159static struct spi_board_info mpc832x_spi_boardinfo = {
160 .bus_num = 0x4c0,
161 .chip_select = 0,
162 .max_speed_hz = 50000000,
163 .modalias = "mmc_spi",
164 .platform_data = &mpc832x_mmc_pdata,
165};
166
167static int __init mpc832x_spi_init(void)
168{
169 par_io_config_pin(3, 0, 3, 0, 1, 0);
170 par_io_config_pin(3, 1, 3, 0, 1, 0);
171 par_io_config_pin(3, 2, 3, 0, 1, 0);
172 par_io_config_pin(3, 3, 2, 0, 1, 0);
173
174 par_io_config_pin(3, 13, 1, 0, 0, 0);
175 par_io_config_pin(3, 14, 2, 0, 0, 0);
176 par_io_config_pin(3, 15, 2, 0, 0, 0);
177
178
179
180
181
182 if (of_find_compatible_node(NULL, NULL, "mmc-spi-slot"))
183 return 0;
184 return fsl_spi_init(&mpc832x_spi_boardinfo, 1, mpc83xx_spi_cs_control);
185}
186machine_device_initcall(mpc832x_rdb, mpc832x_spi_init);
187#endif
188
189
190
191
192
193
194static void __init mpc832x_rdb_setup_arch(void)
195{
196#if defined(CONFIG_QUICC_ENGINE)
197 struct device_node *np;
198#endif
199
200 mpc83xx_setup_arch();
201
202#ifdef CONFIG_QUICC_ENGINE
203 if ((np = of_find_node_by_name(NULL, "par_io")) != NULL) {
204 par_io_init(np);
205 of_node_put(np);
206
207 for (np = NULL; (np = of_find_node_by_name(np, "ucc")) != NULL;)
208 par_io_of_config(np);
209 }
210#endif
211}
212
213machine_device_initcall(mpc832x_rdb, mpc83xx_declare_of_platform_devices);
214
215
216
217
218static int __init mpc832x_rdb_probe(void)
219{
220 return of_machine_is_compatible("MPC832xRDB");
221}
222
223define_machine(mpc832x_rdb) {
224 .name = "MPC832x RDB",
225 .probe = mpc832x_rdb_probe,
226 .setup_arch = mpc832x_rdb_setup_arch,
227 .init_IRQ = mpc83xx_ipic_and_qe_init_IRQ,
228 .get_irq = ipic_get_irq,
229 .restart = mpc83xx_restart,
230 .time_init = mpc83xx_time_init,
231 .calibrate_decr = generic_calibrate_decr,
232 .progress = udbg_progress,
233};
234