Deleted Added
sdiff udiff text old ( 261410 ) new ( 283276 )
full compact
ti_scm.c (261410) ti_scm.c (283276)
1/*
2 * Copyright (c) 2010
3 * Ben Gray <ben.r.gray@gmail.com>.
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:

--- 32 unchanged lines hidden (view full) ---

41 * pins between modules not just GPIO input/output.
42 *
43 * This file contains the generic top level driver, however it relies on chip
44 * specific settings and therefore expects an array of ti_scm_padconf structs
45 * call ti_padconf_devmap to be located somewhere in the kernel.
46 *
47 */
48#include <sys/cdefs.h>
1/*
2 * Copyright (c) 2010
3 * Ben Gray <ben.r.gray@gmail.com>.
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:

--- 32 unchanged lines hidden (view full) ---

41 * pins between modules not just GPIO input/output.
42 *
43 * This file contains the generic top level driver, however it relies on chip
44 * specific settings and therefore expects an array of ti_scm_padconf structs
45 * call ti_padconf_devmap to be located somewhere in the kernel.
46 *
47 */
48#include <sys/cdefs.h>
49__FBSDID("$FreeBSD: head/sys/arm/ti/ti_scm.c 261410 2014-02-02 19:17:28Z ian $");
49__FBSDID("$FreeBSD: head/sys/arm/ti/ti_scm.c 283276 2015-05-22 03:16:18Z gonzo $");
50
51#include <sys/param.h>
52#include <sys/systm.h>
53#include <sys/kernel.h>
54#include <sys/module.h>
55#include <sys/bus.h>
56#include <sys/resource.h>
57#include <sys/rman.h>
58#include <sys/lock.h>
59#include <sys/mutex.h>
60
61#include <machine/bus.h>
62#include <machine/cpu.h>
63#include <machine/cpufunc.h>
64#include <machine/resource.h>
65
66#include <dev/fdt/fdt_common.h>
50
51#include <sys/param.h>
52#include <sys/systm.h>
53#include <sys/kernel.h>
54#include <sys/module.h>
55#include <sys/bus.h>
56#include <sys/resource.h>
57#include <sys/rman.h>
58#include <sys/lock.h>
59#include <sys/mutex.h>
60
61#include <machine/bus.h>
62#include <machine/cpu.h>
63#include <machine/cpufunc.h>
64#include <machine/resource.h>
65
66#include <dev/fdt/fdt_common.h>
67#include <dev/fdt/fdt_pinctrl.h>
67#include <dev/ofw/openfirm.h>
68#include <dev/ofw/ofw_bus.h>
69#include <dev/ofw/ofw_bus_subr.h>
70
71#include "ti_scm.h"
72
73static struct resource_spec ti_scm_res_spec[] = {
74 { SYS_RES_MEMORY, 0, RF_ACTIVE }, /* Control memory window */
75 { -1, 0 }
76};
77
78static struct ti_scm_softc *ti_scm_sc;
79
68#include <dev/ofw/openfirm.h>
69#include <dev/ofw/ofw_bus.h>
70#include <dev/ofw/ofw_bus_subr.h>
71
72#include "ti_scm.h"
73
74static struct resource_spec ti_scm_res_spec[] = {
75 { SYS_RES_MEMORY, 0, RF_ACTIVE }, /* Control memory window */
76 { -1, 0 }
77};
78
79static struct ti_scm_softc *ti_scm_sc;
80
80#define ti_scm_read_2(sc, reg) \
81 bus_space_read_2((sc)->sc_bst, (sc)->sc_bsh, (reg))
82#define ti_scm_write_2(sc, reg, val) \
83 bus_space_write_2((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
84#define ti_scm_read_4(sc, reg) \
85 bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
86#define ti_scm_write_4(sc, reg, val) \
87 bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
88
81#define ti_scm_read_4(sc, reg) \
82 bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
83#define ti_scm_write_4(sc, reg, val) \
84 bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
85
89
90/**
91 * ti_padconf_devmap - Array of pins, should be defined one per SoC
92 *
93 * This array is typically defined in one of the targeted *_scm_pinumx.c
94 * files and is specific to the given SoC platform. Each entry in the array
95 * corresponds to an individual pin.
96 */
97extern const struct ti_scm_device ti_scm_dev;
98
99
100/**
101 * ti_scm_padconf_from_name - searches the list of pads and returns entry
102 * with matching ball name.
103 * @ballname: the name of the ball
104 *
105 * RETURNS:
106 * A pointer to the matching padconf or NULL if the ball wasn't found.
107 */
108static const struct ti_scm_padconf*
109ti_scm_padconf_from_name(const char *ballname)
110{
111 const struct ti_scm_padconf *padconf;
112
113 padconf = ti_scm_dev.padconf;
114 while (padconf->ballname != NULL) {
115 if (strcmp(ballname, padconf->ballname) == 0)
116 return(padconf);
117 padconf++;
118 }
119
120 return (NULL);
121}
122
123/**
124 * ti_scm_padconf_set_internal - sets the muxmode and state for a pad/pin
125 * @padconf: pointer to the pad structure
126 * @muxmode: the name of the mode to use for the pin, i.e. "uart1_rx"
127 * @state: the state to put the pad/pin in, i.e. PADCONF_PIN_???
128 *
129 *
130 * LOCKING:
131 * Internally locks it's own context.
132 *
133 * RETURNS:
134 * 0 on success.
135 * EINVAL if pin requested is outside valid range or already in use.
136 */
137static int
138ti_scm_padconf_set_internal(struct ti_scm_softc *sc,
139 const struct ti_scm_padconf *padconf,
140 const char *muxmode, unsigned int state)
141{
142 unsigned int mode;
143 uint16_t reg_val;
144
145 /* populate the new value for the PADCONF register */
146 reg_val = (uint16_t)(state & ti_scm_dev.padconf_sate_mask);
147
148 /* find the new mode requested */
149 for (mode = 0; mode < 8; mode++) {
150 if ((padconf->muxmodes[mode] != NULL) &&
151 (strcmp(padconf->muxmodes[mode], muxmode) == 0)) {
152 break;
153 }
154 }
155
156 /* couldn't find the mux mode */
157 if (mode >= 8) {
158 printf("Invalid mode \"%s\"\n", muxmode);
159 return (EINVAL);
160 }
161
162 /* set the mux mode */
163 reg_val |= (uint16_t)(mode & ti_scm_dev.padconf_muxmode_mask);
164
165 if (bootverbose)
166 device_printf(sc->sc_dev, "setting internal %x for %s\n",
167 reg_val, muxmode);
168 /* write the register value (16-bit writes) */
169 ti_scm_write_2(sc, padconf->reg_off, reg_val);
170
171 return (0);
172}
173
174/**
175 * ti_scm_padconf_set - sets the muxmode and state for a pad/pin
176 * @padname: the name of the pad, i.e. "c12"
177 * @muxmode: the name of the mode to use for the pin, i.e. "uart1_rx"
178 * @state: the state to put the pad/pin in, i.e. PADCONF_PIN_???
179 *
180 *
181 * LOCKING:
182 * Internally locks it's own context.
183 *
184 * RETURNS:
185 * 0 on success.
186 * EINVAL if pin requested is outside valid range or already in use.
187 */
188int
189ti_scm_padconf_set(const char *padname, const char *muxmode, unsigned int state)
190{
191 const struct ti_scm_padconf *padconf;
192
193 if (!ti_scm_sc)
194 return (ENXIO);
195
196 /* find the pin in the devmap */
197 padconf = ti_scm_padconf_from_name(padname);
198 if (padconf == NULL)
199 return (EINVAL);
200
201 return (ti_scm_padconf_set_internal(ti_scm_sc, padconf, muxmode, state));
202}
203
204/**
205 * ti_scm_padconf_get - gets the muxmode and state for a pad/pin
206 * @padname: the name of the pad, i.e. "c12"
207 * @muxmode: upon return will contain the name of the muxmode of the pin
208 * @state: upon return will contain the state of the pad/pin
209 *
210 *
211 * LOCKING:
212 * Internally locks it's own context.
213 *
214 * RETURNS:
215 * 0 on success.
216 * EINVAL if pin requested is outside valid range or already in use.
217 */
218int
219ti_scm_padconf_get(const char *padname, const char **muxmode,
220 unsigned int *state)
221{
222 const struct ti_scm_padconf *padconf;
223 uint16_t reg_val;
224
225 if (!ti_scm_sc)
226 return (ENXIO);
227
228 /* find the pin in the devmap */
229 padconf = ti_scm_padconf_from_name(padname);
230 if (padconf == NULL)
231 return (EINVAL);
232
233 /* read the register value (16-bit reads) */
234 reg_val = ti_scm_read_2(ti_scm_sc, padconf->reg_off);
235
236 /* save the state */
237 if (state)
238 *state = (reg_val & ti_scm_dev.padconf_sate_mask);
239
240 /* save the mode */
241 if (muxmode)
242 *muxmode = padconf->muxmodes[(reg_val & ti_scm_dev.padconf_muxmode_mask)];
243
244 return (0);
245}
246
247/**
248 * ti_scm_padconf_set_gpiomode - converts a pad to GPIO mode.
249 * @gpio: the GPIO pin number (0-195)
250 * @state: the state to put the pad/pin in, i.e. PADCONF_PIN_???
251 *
252 *
253 *
254 * LOCKING:
255 * Internally locks it's own context.
256 *
257 * RETURNS:
258 * 0 on success.
259 * EINVAL if pin requested is outside valid range or already in use.
260 */
261int
262ti_scm_padconf_set_gpiomode(uint32_t gpio, unsigned int state)
263{
264 const struct ti_scm_padconf *padconf;
265 uint16_t reg_val;
266
267 if (!ti_scm_sc)
268 return (ENXIO);
269
270 /* find the gpio pin in the padconf array */
271 padconf = ti_scm_dev.padconf;
272 while (padconf->ballname != NULL) {
273 if (padconf->gpio_pin == gpio)
274 break;
275 padconf++;
276 }
277 if (padconf->ballname == NULL)
278 return (EINVAL);
279
280 /* populate the new value for the PADCONF register */
281 reg_val = (uint16_t)(state & ti_scm_dev.padconf_sate_mask);
282
283 /* set the mux mode */
284 reg_val |= (uint16_t)(padconf->gpio_mode & ti_scm_dev.padconf_muxmode_mask);
285
286 /* write the register value (16-bit writes) */
287 ti_scm_write_2(ti_scm_sc, padconf->reg_off, reg_val);
288
289 return (0);
290}
291
292/**
293 * ti_scm_padconf_get_gpiomode - gets the current GPIO mode of the pin
294 * @gpio: the GPIO pin number (0-195)
295 * @state: upon return will contain the state
296 *
297 *
298 *
299 * LOCKING:
300 * Internally locks it's own context.
301 *
302 * RETURNS:
303 * 0 on success.
304 * EINVAL if pin requested is outside valid range or not configured as GPIO.
305 */
306int
307ti_scm_padconf_get_gpiomode(uint32_t gpio, unsigned int *state)
308{
309 const struct ti_scm_padconf *padconf;
310 uint16_t reg_val;
311
312 if (!ti_scm_sc)
313 return (ENXIO);
314
315 /* find the gpio pin in the padconf array */
316 padconf = ti_scm_dev.padconf;
317 while (padconf->ballname != NULL) {
318 if (padconf->gpio_pin == gpio)
319 break;
320 padconf++;
321 }
322 if (padconf->ballname == NULL)
323 return (EINVAL);
324
325 /* read the current register settings */
326 reg_val = ti_scm_read_2(ti_scm_sc, padconf->reg_off);
327
328 /* check to make sure the pins is configured as GPIO in the first state */
329 if ((reg_val & ti_scm_dev.padconf_muxmode_mask) != padconf->gpio_mode)
330 return (EINVAL);
331
332 /* read and store the reset of the state, i.e. pull-up, pull-down, etc */
333 if (state)
334 *state = (reg_val & ti_scm_dev.padconf_sate_mask);
335
336 return (0);
337}
338
339/**
340 * ti_scm_padconf_init_from_hints - processes the hints for padconf
341 * @sc: the driver soft context
342 *
343 *
344 *
345 * LOCKING:
346 * Internally locks it's own context.
347 *
348 * RETURNS:
349 * 0 on success.
350 * EINVAL if pin requested is outside valid range or already in use.
351 */
352static int
353ti_scm_padconf_init_from_fdt(struct ti_scm_softc *sc)
354{
355 const struct ti_scm_padconf *padconf;
356 const struct ti_scm_padstate *padstates;
357 int err;
358 phandle_t node;
359 int len;
360 char *fdt_pad_config;
361 int i;
362 char *padname, *muxname, *padstate;
363
364 node = ofw_bus_get_node(sc->sc_dev);
365 len = OF_getproplen(node, "scm-pad-config");
366 OF_getprop_alloc(node, "scm-pad-config", 1, (void **)&fdt_pad_config);
367
368 i = len;
369 while (i > 0) {
370 padname = fdt_pad_config;
371 fdt_pad_config += strlen(padname) + 1;
372 i -= strlen(padname) + 1;
373 if (i <= 0)
374 break;
375
376 muxname = fdt_pad_config;
377 fdt_pad_config += strlen(muxname) + 1;
378 i -= strlen(muxname) + 1;
379 if (i <= 0)
380 break;
381
382 padstate = fdt_pad_config;
383 fdt_pad_config += strlen(padstate) + 1;
384 i -= strlen(padstate) + 1;
385 if (i < 0)
386 break;
387
388 padconf = ti_scm_dev.padconf;
389
390 while (padconf->ballname != NULL) {
391 if (strcmp(padconf->ballname, padname) == 0) {
392 padstates = ti_scm_dev.padstate;
393 err = 1;
394 while (padstates->state != NULL) {
395 if (strcmp(padstates->state, padstate) == 0) {
396 err = ti_scm_padconf_set_internal(sc,
397 padconf, muxname, padstates->reg);
398 }
399 padstates++;
400 }
401 if (err)
402 device_printf(sc->sc_dev,
403 "err: failed to configure "
404 "pin \"%s\" as \"%s\"\n",
405 padconf->ballname,
406 muxname);
407 }
408 padconf++;
409 }
410 }
411 return (0);
412}
413
414/*
415 * Device part of OMAP SCM driver
416 */
86/*
87 * Device part of OMAP SCM driver
88 */
417
418static int
419ti_scm_probe(device_t dev)
420{
89static int
90ti_scm_probe(device_t dev)
91{
421
422 if (!ofw_bus_status_okay(dev))
423 return (ENXIO);
424
92 if (!ofw_bus_status_okay(dev))
93 return (ENXIO);
94
425 if (!ofw_bus_is_compatible(dev, "ti,scm"))
95 if (!ofw_bus_is_compatible(dev, "syscon"))
426 return (ENXIO);
427
96 return (ENXIO);
97
98 if (ti_scm_sc) {
99 printf("%s: multiple SCM modules in device tree data, ignoring\n",
100 __func__);
101 return (EEXIST);
102 }
103
428 device_set_desc(dev, "TI Control Module");
429 return (BUS_PROBE_DEFAULT);
430}
431
432/**
433 * ti_scm_attach - attaches the timer to the simplebus
434 * @dev: new device
435 *
436 * Reserves memory and interrupt resources, stores the softc structure
437 * globally and registers both the timecount and eventtimer objects.
438 *
439 * RETURNS
440 * Zero on sucess or ENXIO if an error occuried.
441 */
442static int
443ti_scm_attach(device_t dev)
444{
445 struct ti_scm_softc *sc = device_get_softc(dev);
446
104 device_set_desc(dev, "TI Control Module");
105 return (BUS_PROBE_DEFAULT);
106}
107
108/**
109 * ti_scm_attach - attaches the timer to the simplebus
110 * @dev: new device
111 *
112 * Reserves memory and interrupt resources, stores the softc structure
113 * globally and registers both the timecount and eventtimer objects.
114 *
115 * RETURNS
116 * Zero on sucess or ENXIO if an error occuried.
117 */
118static int
119ti_scm_attach(device_t dev)
120{
121 struct ti_scm_softc *sc = device_get_softc(dev);
122
447 if (ti_scm_sc)
448 return (ENXIO);
449
450 sc->sc_dev = dev;
451
452 if (bus_alloc_resources(dev, ti_scm_res_spec, sc->sc_res)) {
453 device_printf(dev, "could not allocate resources\n");
454 return (ENXIO);
455 }
456
457 /* Global timer interface */
458 sc->sc_bst = rman_get_bustag(sc->sc_res[0]);
459 sc->sc_bsh = rman_get_bushandle(sc->sc_res[0]);
460
461 ti_scm_sc = sc;
462
123 sc->sc_dev = dev;
124
125 if (bus_alloc_resources(dev, ti_scm_res_spec, sc->sc_res)) {
126 device_printf(dev, "could not allocate resources\n");
127 return (ENXIO);
128 }
129
130 /* Global timer interface */
131 sc->sc_bst = rman_get_bustag(sc->sc_res[0]);
132 sc->sc_bsh = rman_get_bushandle(sc->sc_res[0]);
133
134 ti_scm_sc = sc;
135
463 ti_scm_padconf_init_from_fdt(sc);
464
465 return (0);
466}
467
468int
469ti_scm_reg_read_4(uint32_t reg, uint32_t *val)
470{
471 if (!ti_scm_sc)
472 return (ENXIO);

--- 11 unchanged lines hidden (view full) ---

484 ti_scm_write_4(ti_scm_sc, reg, val);
485 return (0);
486}
487
488
489static device_method_t ti_scm_methods[] = {
490 DEVMETHOD(device_probe, ti_scm_probe),
491 DEVMETHOD(device_attach, ti_scm_attach),
136 return (0);
137}
138
139int
140ti_scm_reg_read_4(uint32_t reg, uint32_t *val)
141{
142 if (!ti_scm_sc)
143 return (ENXIO);

--- 11 unchanged lines hidden (view full) ---

155 ti_scm_write_4(ti_scm_sc, reg, val);
156 return (0);
157}
158
159
160static device_method_t ti_scm_methods[] = {
161 DEVMETHOD(device_probe, ti_scm_probe),
162 DEVMETHOD(device_attach, ti_scm_attach),
163
492 { 0, 0 }
493};
494
495static driver_t ti_scm_driver = {
496 "ti_scm",
497 ti_scm_methods,
498 sizeof(struct ti_scm_softc),
499};
500
501static devclass_t ti_scm_devclass;
502
503DRIVER_MODULE(ti_scm, simplebus, ti_scm_driver, ti_scm_devclass, 0, 0);
164 { 0, 0 }
165};
166
167static driver_t ti_scm_driver = {
168 "ti_scm",
169 ti_scm_methods,
170 sizeof(struct ti_scm_softc),
171};
172
173static devclass_t ti_scm_devclass;
174
175DRIVER_MODULE(ti_scm, simplebus, ti_scm_driver, ti_scm_devclass, 0, 0);