s390.c revision 1.6 1 1.6 thorpej /* $NetBSD: s390.c,v 1.6 2020/01/02 19:00:34 thorpej Exp $ */
2 1.1 phx
3 1.1 phx /*-
4 1.1 phx * Copyright (c) 2011 Frank Wille.
5 1.1 phx * All rights reserved.
6 1.1 phx *
7 1.1 phx * Written by Frank Wille for The NetBSD Project.
8 1.1 phx *
9 1.1 phx * Redistribution and use in source and binary forms, with or without
10 1.1 phx * modification, are permitted provided that the following conditions
11 1.1 phx * are met:
12 1.1 phx * 1. Redistributions of source code must retain the above copyright
13 1.1 phx * notice, this list of conditions and the following disclaimer.
14 1.1 phx * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 phx * notice, this list of conditions and the following disclaimer in the
16 1.1 phx * documentation and/or other materials provided with the distribution.
17 1.1 phx *
18 1.1 phx * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
19 1.1 phx * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
20 1.1 phx * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21 1.1 phx * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
22 1.1 phx * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 1.1 phx * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 1.1 phx * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 1.1 phx * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 1.1 phx * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 1.1 phx * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 1.1 phx * POSSIBILITY OF SUCH DAMAGE.
29 1.1 phx */
30 1.1 phx
31 1.1 phx #include <sys/cdefs.h>
32 1.6 thorpej __KERNEL_RCSID(0, "$NetBSD: s390.c,v 1.6 2020/01/02 19:00:34 thorpej Exp $");
33 1.1 phx
34 1.1 phx #include <sys/param.h>
35 1.1 phx #include <sys/systm.h>
36 1.1 phx #include <sys/device.h>
37 1.1 phx #include <sys/conf.h>
38 1.1 phx
39 1.1 phx #include <dev/clock_subr.h>
40 1.1 phx
41 1.1 phx #include <dev/i2c/i2cvar.h>
42 1.1 phx #include <dev/i2c/s390reg.h>
43 1.1 phx
44 1.1 phx struct s390rtc_softc {
45 1.1 phx device_t sc_dev;
46 1.1 phx i2c_tag_t sc_tag;
47 1.1 phx i2c_addr_t sc_addr;
48 1.1 phx struct todr_chip_handle sc_todr;
49 1.1 phx };
50 1.1 phx
51 1.1 phx static int s390rtc_match(device_t, cfdata_t, void *);
52 1.1 phx static void s390rtc_attach(device_t, device_t, void *);
53 1.1 phx
54 1.1 phx CFATTACH_DECL_NEW(s390rtc, sizeof(struct s390rtc_softc),
55 1.1 phx s390rtc_match, s390rtc_attach, NULL, NULL);
56 1.1 phx
57 1.6 thorpej static int s390rtc_gettime_ymdhms(struct todr_chip_handle *,
58 1.6 thorpej struct clock_ymdhms *);
59 1.6 thorpej static int s390rtc_settime_ymdhms(struct todr_chip_handle *,
60 1.6 thorpej struct clock_ymdhms *);
61 1.1 phx static int s390rtc_read(struct s390rtc_softc *, int, uint8_t *, size_t);
62 1.1 phx static int s390rtc_write(struct s390rtc_softc *, int, uint8_t *, size_t);
63 1.1 phx static uint8_t bitreverse(uint8_t);
64 1.1 phx
65 1.1 phx static int
66 1.1 phx s390rtc_match(device_t parent, cfdata_t cf, void *arg)
67 1.1 phx {
68 1.1 phx struct i2c_attach_args *ia = arg;
69 1.4 thorpej int match_result;
70 1.4 thorpej
71 1.4 thorpej if (iic_use_direct_match(ia, cf, NULL, &match_result))
72 1.4 thorpej return match_result;
73 1.4 thorpej
74 1.4 thorpej /* indirect config - check typical address */
75 1.4 thorpej if (ia->ia_addr == S390_ADDR)
76 1.4 thorpej return I2C_MATCH_ADDRESS_ONLY;
77 1.1 phx
78 1.1 phx return 0;
79 1.1 phx }
80 1.1 phx
81 1.1 phx static void
82 1.1 phx s390rtc_attach(device_t parent, device_t self, void *arg)
83 1.1 phx {
84 1.1 phx struct s390rtc_softc *sc = device_private(self);
85 1.1 phx struct i2c_attach_args *ia = arg;
86 1.1 phx uint8_t reg[1];
87 1.1 phx
88 1.1 phx aprint_naive(": Real-time Clock\n");
89 1.1 phx aprint_normal(": Seiko Instruments 35390A Real-time Clock\n");
90 1.1 phx
91 1.1 phx sc->sc_tag = ia->ia_tag;
92 1.1 phx sc->sc_addr = ia->ia_addr;
93 1.1 phx sc->sc_dev = self;
94 1.1 phx
95 1.1 phx /* Reset the chip and turn on 24h mode, after power-off or battery. */
96 1.5 thorpej if (s390rtc_read(sc, S390_STATUS1, reg, sizeof(reg)))
97 1.1 phx return;
98 1.1 phx if (reg[0] & (S390_ST1_POC | S390_ST1_BLD)) {
99 1.1 phx reg[0] |= S390_ST1_24H | S390_ST1_RESET;
100 1.5 thorpej if (s390rtc_write(sc, S390_STATUS1, reg, sizeof(reg)))
101 1.1 phx return;
102 1.1 phx }
103 1.1 phx
104 1.1 phx /* Disable the test mode, when enabled. */
105 1.5 thorpej if (s390rtc_read(sc, S390_STATUS2, reg, sizeof(reg)))
106 1.1 phx return;
107 1.1 phx if ((reg[0] & S390_ST2_TEST)) {
108 1.1 phx reg[0] &= ~S390_ST2_TEST;
109 1.5 thorpej if (s390rtc_write(sc, S390_STATUS2, reg, sizeof(reg)))
110 1.1 phx return;
111 1.1 phx }
112 1.1 phx
113 1.1 phx sc->sc_todr.cookie = sc;
114 1.6 thorpej sc->sc_todr.todr_gettime = NULL;
115 1.6 thorpej sc->sc_todr.todr_settime = NULL;
116 1.6 thorpej sc->sc_todr.todr_gettime_ymdhms = s390rtc_gettime_ymdhms;
117 1.6 thorpej sc->sc_todr.todr_settime_ymdhms = s390rtc_settime_ymdhms;
118 1.1 phx sc->sc_todr.todr_setwen = NULL;
119 1.1 phx todr_attach(&sc->sc_todr);
120 1.1 phx }
121 1.1 phx
122 1.1 phx static int
123 1.6 thorpej s390rtc_gettime_ymdhms(struct todr_chip_handle *ch, struct clock_ymdhms *dt)
124 1.1 phx {
125 1.1 phx struct s390rtc_softc *sc = ch->cookie;
126 1.1 phx uint8_t bcd[S390_RT1_NBYTES];
127 1.5 thorpej int error;
128 1.1 phx
129 1.5 thorpej if ((error = s390rtc_read(sc, S390_REALTIME1, bcd,
130 1.5 thorpej S390_RT1_NBYTES)) != 0)
131 1.5 thorpej return error;
132 1.1 phx
133 1.1 phx /*
134 1.1 phx * Convert the register values into something useable.
135 1.1 phx */
136 1.3 christos dt->dt_sec = bcdtobin(bcd[S390_RT1_SECOND]);
137 1.3 christos dt->dt_min = bcdtobin(bcd[S390_RT1_MINUTE]);
138 1.3 christos dt->dt_hour = bcdtobin(bcd[S390_RT1_HOUR] & 0x3f);
139 1.3 christos dt->dt_day = bcdtobin(bcd[S390_RT1_DAY]);
140 1.3 christos dt->dt_mon = bcdtobin(bcd[S390_RT1_MONTH]);
141 1.3 christos dt->dt_year = bcdtobin(bcd[S390_RT1_YEAR]) + 2000;
142 1.1 phx
143 1.5 thorpej return 0;
144 1.1 phx }
145 1.1 phx
146 1.1 phx static int
147 1.6 thorpej s390rtc_settime_ymdhms(struct todr_chip_handle *ch, struct clock_ymdhms *dt)
148 1.1 phx {
149 1.6 thorpej struct s390rtc_softc *sc = ch->cookie;
150 1.1 phx uint8_t bcd[S390_RT1_NBYTES];
151 1.1 phx
152 1.1 phx /*
153 1.1 phx * Convert our time representation into something the S-xx390
154 1.1 phx * can understand.
155 1.1 phx */
156 1.3 christos bcd[S390_RT1_SECOND] = bintobcd(dt->dt_sec);
157 1.3 christos bcd[S390_RT1_MINUTE] = bintobcd(dt->dt_min);
158 1.3 christos bcd[S390_RT1_HOUR] = bintobcd(dt->dt_hour);
159 1.3 christos bcd[S390_RT1_DAY] = bintobcd(dt->dt_day);
160 1.3 christos bcd[S390_RT1_WDAY] = bintobcd(dt->dt_wday);
161 1.3 christos bcd[S390_RT1_MONTH] = bintobcd(dt->dt_mon);
162 1.3 christos bcd[S390_RT1_YEAR] = bintobcd(dt->dt_year % 100);
163 1.1 phx
164 1.1 phx return s390rtc_write(sc, S390_REALTIME1, bcd, S390_RT1_NBYTES);
165 1.1 phx }
166 1.1 phx
167 1.1 phx static int
168 1.1 phx s390rtc_read(struct s390rtc_softc *sc, int reg, uint8_t *buf, size_t len)
169 1.1 phx {
170 1.5 thorpej int i, error;
171 1.1 phx
172 1.5 thorpej if ((error = iic_acquire_bus(sc->sc_tag, 0)) != 0) {
173 1.1 phx aprint_error_dev(sc->sc_dev,
174 1.1 phx "%s: failed to acquire I2C bus\n", __func__);
175 1.5 thorpej return error;
176 1.1 phx }
177 1.1 phx
178 1.5 thorpej if ((error = iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
179 1.5 thorpej sc->sc_addr + reg, NULL, 0, buf, len, 0)) != 0) {
180 1.5 thorpej iic_release_bus(sc->sc_tag, 0);
181 1.1 phx aprint_error_dev(sc->sc_dev,
182 1.1 phx "%s: failed to read reg%d\n", __func__, reg);
183 1.5 thorpej return error;
184 1.1 phx }
185 1.1 phx
186 1.5 thorpej iic_release_bus(sc->sc_tag, 0);
187 1.1 phx
188 1.1 phx /* this chip returns each byte in reverse order */
189 1.1 phx for (i = 0; i < len; i++)
190 1.1 phx buf[i] = bitreverse(buf[i]);
191 1.1 phx
192 1.5 thorpej return 0;
193 1.1 phx }
194 1.1 phx
195 1.1 phx static int
196 1.1 phx s390rtc_write(struct s390rtc_softc *sc, int reg, uint8_t *buf, size_t len)
197 1.1 phx {
198 1.5 thorpej int i, error;
199 1.1 phx
200 1.5 thorpej if ((error = iic_acquire_bus(sc->sc_tag, 0)) != 0) {
201 1.1 phx aprint_error_dev(sc->sc_dev,
202 1.1 phx "%s: failed to acquire I2C bus\n", __func__);
203 1.5 thorpej return error;
204 1.1 phx }
205 1.1 phx
206 1.1 phx /* this chip expects each byte in reverse order */
207 1.1 phx for (i = 0; i < len; i++)
208 1.1 phx buf[i] = bitreverse(buf[i]);
209 1.1 phx
210 1.5 thorpej if ((error = iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
211 1.5 thorpej sc->sc_addr + reg, NULL, 0, buf, len, 0)) != 0) {
212 1.5 thorpej iic_release_bus(sc->sc_tag, 0);
213 1.1 phx aprint_error_dev(sc->sc_dev,
214 1.1 phx "%s: failed to write reg%d\n", __func__, reg);
215 1.5 thorpej return error;
216 1.1 phx }
217 1.1 phx
218 1.5 thorpej iic_release_bus(sc->sc_tag, 0);
219 1.5 thorpej return 0;
220 1.1 phx }
221 1.1 phx
222 1.1 phx static uint8_t
223 1.1 phx bitreverse(uint8_t x)
224 1.1 phx {
225 1.1 phx static unsigned char nibbletab[16] = {
226 1.1 phx 0, 8, 4, 12, 2, 10, 6, 14, 1, 9, 5, 13, 3, 11, 7, 15
227 1.1 phx };
228 1.1 phx
229 1.1 phx return (nibbletab[x & 15] << 4) | nibbletab[x >> 4];
230 1.1 phx }
231