13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
14 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
15 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
16 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
17 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
18 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
19 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
20 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
21 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
22 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
| 13 * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND
14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
16 * ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE
17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
23 * SUCH DAMAGE.
|
27
28#include <sys/param.h>
29#include <sys/systm.h>
30#include <sys/bus.h>
31#include <sys/clock.h>
32#include <sys/conf.h>
33#include <sys/kernel.h>
34#include <sys/lock.h>
35#include <sys/mbuf.h>
36#include <sys/malloc.h>
37#include <sys/module.h>
38#include <sys/mutex.h>
39#include <sys/rman.h>
40#include <machine/bus.h>
41
42#include <arm/at91/at91_rtcreg.h>
43
44#include "clock_if.h"
45
46struct at91_rtc_softc
47{
48 device_t dev; /* Myself */
49 void *intrhand; /* Interrupt handle */
50 struct resource *irq_res; /* IRQ resource */
51 struct resource *mem_res; /* Memory resource */
52 struct mtx sc_mtx; /* basically a perimeter lock */
53};
54
55static inline uint32_t
56RD4(struct at91_rtc_softc *sc, bus_size_t off)
57{
58 return bus_read_4(sc->mem_res, off);
59}
60
61static inline void
62WR4(struct at91_rtc_softc *sc, bus_size_t off, uint32_t val)
63{
64 bus_write_4(sc->mem_res, off, val);
65}
66
67#define AT91_RTC_LOCK(_sc) mtx_lock_spin(&(_sc)->sc_mtx)
68#define AT91_RTC_UNLOCK(_sc) mtx_unlock_spin(&(_sc)->sc_mtx)
69#define AT91_RTC_LOCK_INIT(_sc) \
70 mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->dev), \
71 "rtc", MTX_SPIN)
72#define AT91_RTC_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx);
73#define AT91_RTC_ASSERT_LOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_OWNED);
74#define AT91_RTC_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED);
75
76static devclass_t at91_rtc_devclass;
77
78/* bus entry points */
79
80static int at91_rtc_probe(device_t dev);
81static int at91_rtc_attach(device_t dev);
82static int at91_rtc_detach(device_t dev);
83static int at91_rtc_intr(void *);
84
85/* helper routines */
86static int at91_rtc_activate(device_t dev);
87static void at91_rtc_deactivate(device_t dev);
88
89static int
90at91_rtc_probe(device_t dev)
91{
92 device_set_desc(dev, "RTC");
93 return (0);
94}
95
96static int
97at91_rtc_attach(device_t dev)
98{
99 struct at91_rtc_softc *sc = device_get_softc(dev);
100 int err;
101
102 sc->dev = dev;
103 err = at91_rtc_activate(dev);
104 if (err)
105 goto out;
106
107 AT91_RTC_LOCK_INIT(sc);
108
109 /*
110 * Activate the interrupt, but disable all interrupts in the hardware
111 */
112 WR4(sc, RTC_IDR, 0xffffffff);
113 err = bus_setup_intr(dev, sc->irq_res, INTR_TYPE_MISC,
114 at91_rtc_intr, NULL, sc, &sc->intrhand);
115 if (err) {
116 AT91_RTC_LOCK_DESTROY(sc);
117 goto out;
118 }
119 clock_register(dev, 1000000);
120out:;
121 if (err)
122 at91_rtc_deactivate(dev);
123 return (err);
124}
125
126static int
127at91_rtc_detach(device_t dev)
128{
129 return (EBUSY); /* XXX */
130}
131
132static int
133at91_rtc_activate(device_t dev)
134{
135 struct at91_rtc_softc *sc;
136 int rid;
137
138 sc = device_get_softc(dev);
139 rid = 0;
140 sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
141 RF_ACTIVE);
142 if (sc->mem_res == NULL)
143 goto errout;
144 rid = 0;
145 sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
146 RF_ACTIVE | RF_SHAREABLE);
147 if (sc->irq_res == NULL)
148 goto errout;
149 return (0);
150errout:
151 at91_rtc_deactivate(dev);
152 return (ENOMEM);
153}
154
155static void
156at91_rtc_deactivate(device_t dev)
157{
158 struct at91_rtc_softc *sc;
159
160 sc = device_get_softc(dev);
161 if (sc->intrhand)
162 bus_teardown_intr(dev, sc->irq_res, sc->intrhand);
163 sc->intrhand = 0;
164 bus_generic_detach(sc->dev);
165 if (sc->mem_res)
166 bus_release_resource(dev, SYS_RES_IOPORT,
167 rman_get_rid(sc->mem_res), sc->mem_res);
168 sc->mem_res = 0;
169 if (sc->irq_res)
170 bus_release_resource(dev, SYS_RES_IRQ,
171 rman_get_rid(sc->irq_res), sc->irq_res);
172 sc->irq_res = 0;
173 return;
174}
175
176static int
177at91_rtc_intr(void *xsc)
178{
179 struct at91_rtc_softc *sc = xsc;
180#if 0
181 uint32_t status;
182
183 /* Reading the status also clears the interrupt */
184 status = RD4(sc, RTC_SR);
185 if (status == 0)
186 return;
187 AT91_RTC_LOCK(sc);
188 AT91_RTC_UNLOCK(sc);
189#endif
190 wakeup(sc);
191 return (FILTER_HANDLED);
192}
193
194/*
195 * Get the time of day clock and return it in ts.
196 * Return 0 on success, an error number otherwise.
197 */
198static int
199at91_rtc_gettime(device_t dev, struct timespec *ts)
200{
201 struct clocktime ct;
202 uint32_t timr, calr;
203 struct at91_rtc_softc *sc;
204
205 sc = device_get_softc(dev);
206 timr = RD4(sc, RTC_TIMR);
207 calr = RD4(sc, RTC_CALR);
208 ct.nsec = 0;
209 ct.sec = RTC_TIMR_SEC(timr);
210 ct.min = RTC_TIMR_MIN(timr);
211 ct.hour = RTC_TIMR_HR(timr);
212 ct.year = RTC_CALR_CEN(calr) * 100 + RTC_CALR_YEAR(calr);
213 ct.mon = RTC_CALR_MON(calr);
214 ct.day = RTC_CALR_DAY(calr);
215 ct.dow = -1;
216 return clock_ct_to_ts(&ct, ts);
217}
218
219/*
220 * Set the time of day clock based on the value of the struct timespec arg.
221 * Return 0 on success, an error number otherwise.
222 */
223static int
224at91_rtc_settime(device_t dev, struct timespec *ts)
225{
226 struct at91_rtc_softc *sc;
227 struct clocktime ct;
228
229 sc = device_get_softc(dev);
230 clock_ts_to_ct(ts, &ct);
231 WR4(sc, RTC_TIMR, RTC_TIMR_MK(ct.hour, ct.min, ct.sec));
232 WR4(sc, RTC_CALR, RTC_CALR_MK(ct.year, ct.mon, ct.day, ct.dow));
233 return (0);
234}
235
236static device_method_t at91_rtc_methods[] = {
237 /* Device interface */
238 DEVMETHOD(device_probe, at91_rtc_probe),
239 DEVMETHOD(device_attach, at91_rtc_attach),
240 DEVMETHOD(device_detach, at91_rtc_detach),
241
242 /* clock interface */
243 DEVMETHOD(clock_gettime, at91_rtc_gettime),
244 DEVMETHOD(clock_settime, at91_rtc_settime),
245
246 { 0, 0 }
247};
248
249static driver_t at91_rtc_driver = {
250 "at91_rtc",
251 at91_rtc_methods,
252 sizeof(struct at91_rtc_softc),
253};
254
255DRIVER_MODULE(at91_rtc, atmelarm, at91_rtc_driver, at91_rtc_devclass, 0, 0);
| 28
29#include <sys/param.h>
30#include <sys/systm.h>
31#include <sys/bus.h>
32#include <sys/clock.h>
33#include <sys/conf.h>
34#include <sys/kernel.h>
35#include <sys/lock.h>
36#include <sys/mbuf.h>
37#include <sys/malloc.h>
38#include <sys/module.h>
39#include <sys/mutex.h>
40#include <sys/rman.h>
41#include <machine/bus.h>
42
43#include <arm/at91/at91_rtcreg.h>
44
45#include "clock_if.h"
46
47struct at91_rtc_softc
48{
49 device_t dev; /* Myself */
50 void *intrhand; /* Interrupt handle */
51 struct resource *irq_res; /* IRQ resource */
52 struct resource *mem_res; /* Memory resource */
53 struct mtx sc_mtx; /* basically a perimeter lock */
54};
55
56static inline uint32_t
57RD4(struct at91_rtc_softc *sc, bus_size_t off)
58{
59 return bus_read_4(sc->mem_res, off);
60}
61
62static inline void
63WR4(struct at91_rtc_softc *sc, bus_size_t off, uint32_t val)
64{
65 bus_write_4(sc->mem_res, off, val);
66}
67
68#define AT91_RTC_LOCK(_sc) mtx_lock_spin(&(_sc)->sc_mtx)
69#define AT91_RTC_UNLOCK(_sc) mtx_unlock_spin(&(_sc)->sc_mtx)
70#define AT91_RTC_LOCK_INIT(_sc) \
71 mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->dev), \
72 "rtc", MTX_SPIN)
73#define AT91_RTC_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx);
74#define AT91_RTC_ASSERT_LOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_OWNED);
75#define AT91_RTC_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED);
76
77static devclass_t at91_rtc_devclass;
78
79/* bus entry points */
80
81static int at91_rtc_probe(device_t dev);
82static int at91_rtc_attach(device_t dev);
83static int at91_rtc_detach(device_t dev);
84static int at91_rtc_intr(void *);
85
86/* helper routines */
87static int at91_rtc_activate(device_t dev);
88static void at91_rtc_deactivate(device_t dev);
89
90static int
91at91_rtc_probe(device_t dev)
92{
93 device_set_desc(dev, "RTC");
94 return (0);
95}
96
97static int
98at91_rtc_attach(device_t dev)
99{
100 struct at91_rtc_softc *sc = device_get_softc(dev);
101 int err;
102
103 sc->dev = dev;
104 err = at91_rtc_activate(dev);
105 if (err)
106 goto out;
107
108 AT91_RTC_LOCK_INIT(sc);
109
110 /*
111 * Activate the interrupt, but disable all interrupts in the hardware
112 */
113 WR4(sc, RTC_IDR, 0xffffffff);
114 err = bus_setup_intr(dev, sc->irq_res, INTR_TYPE_MISC,
115 at91_rtc_intr, NULL, sc, &sc->intrhand);
116 if (err) {
117 AT91_RTC_LOCK_DESTROY(sc);
118 goto out;
119 }
120 clock_register(dev, 1000000);
121out:;
122 if (err)
123 at91_rtc_deactivate(dev);
124 return (err);
125}
126
127static int
128at91_rtc_detach(device_t dev)
129{
130 return (EBUSY); /* XXX */
131}
132
133static int
134at91_rtc_activate(device_t dev)
135{
136 struct at91_rtc_softc *sc;
137 int rid;
138
139 sc = device_get_softc(dev);
140 rid = 0;
141 sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
142 RF_ACTIVE);
143 if (sc->mem_res == NULL)
144 goto errout;
145 rid = 0;
146 sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
147 RF_ACTIVE | RF_SHAREABLE);
148 if (sc->irq_res == NULL)
149 goto errout;
150 return (0);
151errout:
152 at91_rtc_deactivate(dev);
153 return (ENOMEM);
154}
155
156static void
157at91_rtc_deactivate(device_t dev)
158{
159 struct at91_rtc_softc *sc;
160
161 sc = device_get_softc(dev);
162 if (sc->intrhand)
163 bus_teardown_intr(dev, sc->irq_res, sc->intrhand);
164 sc->intrhand = 0;
165 bus_generic_detach(sc->dev);
166 if (sc->mem_res)
167 bus_release_resource(dev, SYS_RES_IOPORT,
168 rman_get_rid(sc->mem_res), sc->mem_res);
169 sc->mem_res = 0;
170 if (sc->irq_res)
171 bus_release_resource(dev, SYS_RES_IRQ,
172 rman_get_rid(sc->irq_res), sc->irq_res);
173 sc->irq_res = 0;
174 return;
175}
176
177static int
178at91_rtc_intr(void *xsc)
179{
180 struct at91_rtc_softc *sc = xsc;
181#if 0
182 uint32_t status;
183
184 /* Reading the status also clears the interrupt */
185 status = RD4(sc, RTC_SR);
186 if (status == 0)
187 return;
188 AT91_RTC_LOCK(sc);
189 AT91_RTC_UNLOCK(sc);
190#endif
191 wakeup(sc);
192 return (FILTER_HANDLED);
193}
194
195/*
196 * Get the time of day clock and return it in ts.
197 * Return 0 on success, an error number otherwise.
198 */
199static int
200at91_rtc_gettime(device_t dev, struct timespec *ts)
201{
202 struct clocktime ct;
203 uint32_t timr, calr;
204 struct at91_rtc_softc *sc;
205
206 sc = device_get_softc(dev);
207 timr = RD4(sc, RTC_TIMR);
208 calr = RD4(sc, RTC_CALR);
209 ct.nsec = 0;
210 ct.sec = RTC_TIMR_SEC(timr);
211 ct.min = RTC_TIMR_MIN(timr);
212 ct.hour = RTC_TIMR_HR(timr);
213 ct.year = RTC_CALR_CEN(calr) * 100 + RTC_CALR_YEAR(calr);
214 ct.mon = RTC_CALR_MON(calr);
215 ct.day = RTC_CALR_DAY(calr);
216 ct.dow = -1;
217 return clock_ct_to_ts(&ct, ts);
218}
219
220/*
221 * Set the time of day clock based on the value of the struct timespec arg.
222 * Return 0 on success, an error number otherwise.
223 */
224static int
225at91_rtc_settime(device_t dev, struct timespec *ts)
226{
227 struct at91_rtc_softc *sc;
228 struct clocktime ct;
229
230 sc = device_get_softc(dev);
231 clock_ts_to_ct(ts, &ct);
232 WR4(sc, RTC_TIMR, RTC_TIMR_MK(ct.hour, ct.min, ct.sec));
233 WR4(sc, RTC_CALR, RTC_CALR_MK(ct.year, ct.mon, ct.day, ct.dow));
234 return (0);
235}
236
237static device_method_t at91_rtc_methods[] = {
238 /* Device interface */
239 DEVMETHOD(device_probe, at91_rtc_probe),
240 DEVMETHOD(device_attach, at91_rtc_attach),
241 DEVMETHOD(device_detach, at91_rtc_detach),
242
243 /* clock interface */
244 DEVMETHOD(clock_gettime, at91_rtc_gettime),
245 DEVMETHOD(clock_settime, at91_rtc_settime),
246
247 { 0, 0 }
248};
249
250static driver_t at91_rtc_driver = {
251 "at91_rtc",
252 at91_rtc_methods,
253 sizeof(struct at91_rtc_softc),
254};
255
256DRIVER_MODULE(at91_rtc, atmelarm, at91_rtc_driver, at91_rtc_devclass, 0, 0);
|