Deleted Added
full compact
rk30xx_pmu.c (259329) rk30xx_pmu.c (266152)
1/*-
2 * Copyright (c) 2013 Ganbold Tsagaankhuu <ganbold@gmail.com>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27/* PMU for Rockchip RK30xx */
28
29#include <sys/cdefs.h>
1/*-
2 * Copyright (c) 2013 Ganbold Tsagaankhuu <ganbold@gmail.com>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27/* PMU for Rockchip RK30xx */
28
29#include <sys/cdefs.h>
30__FBSDID("$FreeBSD: stable/10/sys/arm/rockchip/rk30xx_pmu.c 259329 2013-12-13 20:43:11Z ian $");
30__FBSDID("$FreeBSD: stable/10/sys/arm/rockchip/rk30xx_pmu.c 266152 2014-05-15 16:11:06Z ian $");
31
32#include <sys/param.h>
33#include <sys/systm.h>
34#include <sys/bus.h>
35#include <sys/kernel.h>
36#include <sys/module.h>
37#include <sys/malloc.h>
38#include <sys/rman.h>
39#include <sys/timeet.h>
40#include <sys/timetc.h>
41#include <sys/watchdog.h>
42#include <machine/bus.h>
43#include <machine/cpu.h>
44#include <machine/intr.h>
45
46#include <dev/fdt/fdt_common.h>
47#include <dev/ofw/openfirm.h>
48#include <dev/ofw/ofw_bus.h>
49#include <dev/ofw/ofw_bus_subr.h>
50
51#include <machine/bus.h>
52#include <machine/fdt.h>
53
54#include "rk30xx_pmu.h"
55
56struct rk30_pmu_softc {
57 struct resource *res;
58 bus_space_tag_t bst;
59 bus_space_handle_t bsh;
60};
61
62static struct rk30_pmu_softc *rk30_pmu_sc = NULL;
63
64#define pmu_read_4(sc, reg) \
65 bus_space_read_4((sc)->bst, (sc)->bsh, (reg))
66#define pmu_write_4(sc, reg, val) \
67 bus_space_write_4((sc)->bst, (sc)->bsh, (reg), (val))
68
69static int
70rk30_pmu_probe(device_t dev)
71{
72
31
32#include <sys/param.h>
33#include <sys/systm.h>
34#include <sys/bus.h>
35#include <sys/kernel.h>
36#include <sys/module.h>
37#include <sys/malloc.h>
38#include <sys/rman.h>
39#include <sys/timeet.h>
40#include <sys/timetc.h>
41#include <sys/watchdog.h>
42#include <machine/bus.h>
43#include <machine/cpu.h>
44#include <machine/intr.h>
45
46#include <dev/fdt/fdt_common.h>
47#include <dev/ofw/openfirm.h>
48#include <dev/ofw/ofw_bus.h>
49#include <dev/ofw/ofw_bus_subr.h>
50
51#include <machine/bus.h>
52#include <machine/fdt.h>
53
54#include "rk30xx_pmu.h"
55
56struct rk30_pmu_softc {
57 struct resource *res;
58 bus_space_tag_t bst;
59 bus_space_handle_t bsh;
60};
61
62static struct rk30_pmu_softc *rk30_pmu_sc = NULL;
63
64#define pmu_read_4(sc, reg) \
65 bus_space_read_4((sc)->bst, (sc)->bsh, (reg))
66#define pmu_write_4(sc, reg, val) \
67 bus_space_write_4((sc)->bst, (sc)->bsh, (reg), (val))
68
69static int
70rk30_pmu_probe(device_t dev)
71{
72
73 if (!ofw_bus_status_okay(dev))
74 return (ENXIO);
75
73 if (ofw_bus_is_compatible(dev, "rockchip,rk30xx-pmu")) {
74 device_set_desc(dev, "RK30XX PMU");
75 return(BUS_PROBE_DEFAULT);
76 }
77
78 return (ENXIO);
79}
80
81static int
82rk30_pmu_attach(device_t dev)
83{
84 struct rk30_pmu_softc *sc = device_get_softc(dev);
85 int rid = 0;
86
87 if (rk30_pmu_sc)
88 return (ENXIO);
89
90 sc->res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, RF_ACTIVE);
91 if (!sc->res) {
92 device_printf(dev, "could not allocate resource\n");
93 return (ENXIO);
94 }
95
96 sc->bst = rman_get_bustag(sc->res);
97 sc->bsh = rman_get_bushandle(sc->res);
98
99 rk30_pmu_sc = sc;
100
101 return (0);
102}
103
104static device_method_t rk30_pmu_methods[] = {
105 DEVMETHOD(device_probe, rk30_pmu_probe),
106 DEVMETHOD(device_attach, rk30_pmu_attach),
107 { 0, 0 }
108};
109
110static driver_t rk30_pmu_driver = {
111 "rk30_pmu",
112 rk30_pmu_methods,
113 sizeof(struct rk30_pmu_softc),
114};
115
116static devclass_t rk30_pmu_devclass;
117
118DRIVER_MODULE(rk30_pmu, simplebus, rk30_pmu_driver, rk30_pmu_devclass, 0, 0);
119
120void
121rk30_pmu_gpio_pud(uint32_t pin, uint32_t state)
122{
123 uint32_t offset;
124
125 offset = PMU_GPIO0A_PULL + ((pin / 8) * 4);
126 pin = (pin % 8) * 2;
127 pmu_write_4(rk30_pmu_sc, offset, (0x3 << (16 + pin)) | (state << pin));
128}
129
76 if (ofw_bus_is_compatible(dev, "rockchip,rk30xx-pmu")) {
77 device_set_desc(dev, "RK30XX PMU");
78 return(BUS_PROBE_DEFAULT);
79 }
80
81 return (ENXIO);
82}
83
84static int
85rk30_pmu_attach(device_t dev)
86{
87 struct rk30_pmu_softc *sc = device_get_softc(dev);
88 int rid = 0;
89
90 if (rk30_pmu_sc)
91 return (ENXIO);
92
93 sc->res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, RF_ACTIVE);
94 if (!sc->res) {
95 device_printf(dev, "could not allocate resource\n");
96 return (ENXIO);
97 }
98
99 sc->bst = rman_get_bustag(sc->res);
100 sc->bsh = rman_get_bushandle(sc->res);
101
102 rk30_pmu_sc = sc;
103
104 return (0);
105}
106
107static device_method_t rk30_pmu_methods[] = {
108 DEVMETHOD(device_probe, rk30_pmu_probe),
109 DEVMETHOD(device_attach, rk30_pmu_attach),
110 { 0, 0 }
111};
112
113static driver_t rk30_pmu_driver = {
114 "rk30_pmu",
115 rk30_pmu_methods,
116 sizeof(struct rk30_pmu_softc),
117};
118
119static devclass_t rk30_pmu_devclass;
120
121DRIVER_MODULE(rk30_pmu, simplebus, rk30_pmu_driver, rk30_pmu_devclass, 0, 0);
122
123void
124rk30_pmu_gpio_pud(uint32_t pin, uint32_t state)
125{
126 uint32_t offset;
127
128 offset = PMU_GPIO0A_PULL + ((pin / 8) * 4);
129 pin = (pin % 8) * 2;
130 pmu_write_4(rk30_pmu_sc, offset, (0x3 << (16 + pin)) | (state << pin));
131}
132