Deleted Added
full compact
smb.c (103588) smb.c (111815)
1/*-
2 * Copyright (c) 1998, 2001 Nicolas Souchu
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 *
1/*-
2 * Copyright (c) 1998, 2001 Nicolas Souchu
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 * $FreeBSD: head/sys/dev/smbus/smb.c 103588 2002-09-19 03:25:46Z peter $
26 * $FreeBSD: head/sys/dev/smbus/smb.c 111815 2003-03-03 12:15:54Z phk $
27 *
28 */
29#include <sys/param.h>
30#include <sys/kernel.h>
31#include <sys/systm.h>
32#include <sys/module.h>
33#include <sys/bus.h>
34#include <sys/conf.h>
35#include <sys/uio.h>
36#include <sys/fcntl.h>
37
38#include <dev/smbus/smbconf.h>
39#include <dev/smbus/smbus.h>
40#include <dev/smbus/smb.h>
41
42#include "smbus_if.h"
43
44#define BUFSIZE 1024
45
46struct smb_softc {
47
48 int sc_count; /* >0 if device opened */
49 dev_t sc_devnode;
50};
51
52#define IIC_SOFTC(unit) \
53 ((struct smb_softc *)devclass_get_softc(smb_devclass, (unit)))
54
55#define IIC_DEVICE(unit) \
56 (devclass_get_device(smb_devclass, (unit)))
57
58static int smb_probe(device_t);
59static int smb_attach(device_t);
60static int smb_detach(device_t);
61static void smb_identify(driver_t *driver, device_t parent);
62
63static devclass_t smb_devclass;
64
65static device_method_t smb_methods[] = {
66 /* device interface */
67 DEVMETHOD(device_identify, smb_identify),
68 DEVMETHOD(device_probe, smb_probe),
69 DEVMETHOD(device_attach, smb_attach),
70 DEVMETHOD(device_detach, smb_detach),
71
72 /* smbus interface */
73 DEVMETHOD(smbus_intr, smbus_generic_intr),
74
75 { 0, 0 }
76};
77
78static driver_t smb_driver = {
79 "smb",
80 smb_methods,
81 sizeof(struct smb_softc),
82};
83
84static d_open_t smbopen;
85static d_close_t smbclose;
86static d_write_t smbwrite;
87static d_read_t smbread;
88static d_ioctl_t smbioctl;
89
90#define CDEV_MAJOR 106
91static struct cdevsw smb_cdevsw = {
27 *
28 */
29#include <sys/param.h>
30#include <sys/kernel.h>
31#include <sys/systm.h>
32#include <sys/module.h>
33#include <sys/bus.h>
34#include <sys/conf.h>
35#include <sys/uio.h>
36#include <sys/fcntl.h>
37
38#include <dev/smbus/smbconf.h>
39#include <dev/smbus/smbus.h>
40#include <dev/smbus/smb.h>
41
42#include "smbus_if.h"
43
44#define BUFSIZE 1024
45
46struct smb_softc {
47
48 int sc_count; /* >0 if device opened */
49 dev_t sc_devnode;
50};
51
52#define IIC_SOFTC(unit) \
53 ((struct smb_softc *)devclass_get_softc(smb_devclass, (unit)))
54
55#define IIC_DEVICE(unit) \
56 (devclass_get_device(smb_devclass, (unit)))
57
58static int smb_probe(device_t);
59static int smb_attach(device_t);
60static int smb_detach(device_t);
61static void smb_identify(driver_t *driver, device_t parent);
62
63static devclass_t smb_devclass;
64
65static device_method_t smb_methods[] = {
66 /* device interface */
67 DEVMETHOD(device_identify, smb_identify),
68 DEVMETHOD(device_probe, smb_probe),
69 DEVMETHOD(device_attach, smb_attach),
70 DEVMETHOD(device_detach, smb_detach),
71
72 /* smbus interface */
73 DEVMETHOD(smbus_intr, smbus_generic_intr),
74
75 { 0, 0 }
76};
77
78static driver_t smb_driver = {
79 "smb",
80 smb_methods,
81 sizeof(struct smb_softc),
82};
83
84static d_open_t smbopen;
85static d_close_t smbclose;
86static d_write_t smbwrite;
87static d_read_t smbread;
88static d_ioctl_t smbioctl;
89
90#define CDEV_MAJOR 106
91static struct cdevsw smb_cdevsw = {
92 /* open */ smbopen,
93 /* close */ smbclose,
94 /* read */ smbread,
95 /* write */ smbwrite,
96 /* ioctl */ smbioctl,
97 /* poll */ nopoll,
98 /* mmap */ nommap,
99 /* strategy */ nostrategy,
100 /* name */ "smb",
101 /* maj */ CDEV_MAJOR,
102 /* dump */ nodump,
103 /* psize */ nopsize,
104 /* flags */ 0,
92 .d_open = smbopen,
93 .d_close = smbclose,
94 .d_read = smbread,
95 .d_write = smbwrite,
96 .d_ioctl = smbioctl,
97 .d_name = "smb",
98 .d_maj = CDEV_MAJOR,
105};
106
107static void
108smb_identify(driver_t *driver, device_t parent)
109{
110 BUS_ADD_CHILD(parent, 0, "smb", 0);
111}
112
113static int
114smb_probe(device_t dev)
115{
116 device_set_desc(dev, "SMBus generic I/O");
117
118 return (0);
119}
120
121static int
122smb_attach(device_t dev)
123{
124 struct smb_softc *sc = (struct smb_softc *)device_get_softc(dev);
125
126 if (!sc)
127 return (ENOMEM);
128
129 bzero(sc, sizeof(struct smb_softc *));
130
131 sc->sc_devnode = make_dev(&smb_cdevsw, device_get_unit(dev),
132 UID_ROOT, GID_WHEEL,
133 0600, "smb%d", device_get_unit(dev));
134
135 return (0);
136}
137
138static int
139smb_detach(device_t dev)
140{
141 struct smb_softc *sc = (struct smb_softc *)device_get_softc(dev);
142
143 if (sc->sc_devnode)
144 destroy_dev(sc->sc_devnode);
145
146 return (0);
147}
148
149static int
150smbopen (dev_t dev, int flags, int fmt, struct thread *td)
151{
152 struct smb_softc *sc = IIC_SOFTC(minor(dev));
153
154 if (!sc)
155 return (EINVAL);
156
157 if (sc->sc_count)
158 return (EBUSY);
159
160 sc->sc_count++;
161
162 return (0);
163}
164
165static int
166smbclose(dev_t dev, int flags, int fmt, struct thread *td)
167{
168 struct smb_softc *sc = IIC_SOFTC(minor(dev));
169
170 if (!sc)
171 return (EINVAL);
172
173 if (!sc->sc_count)
174 return (EINVAL);
175
176 sc->sc_count--;
177
178 return (0);
179}
180
181static int
182smbwrite(dev_t dev, struct uio * uio, int ioflag)
183{
184 /* not supported */
185
186 return (EINVAL);
187}
188
189static int
190smbread(dev_t dev, struct uio * uio, int ioflag)
191{
192 /* not supported */
193
194 return (EINVAL);
195}
196
197static int
198smbioctl(dev_t dev, u_long cmd, caddr_t data, int flags, struct thread *td)
199{
200 device_t smbdev = IIC_DEVICE(minor(dev));
201 struct smb_softc *sc = IIC_SOFTC(minor(dev));
202 device_t parent = device_get_parent(smbdev);
203
204 int error = 0;
205 struct smbcmd *s = (struct smbcmd *)data;
206
207 if (!sc || !s)
208 return (EINVAL);
209
210 /* allocate the bus */
211 if ((error = smbus_request_bus(parent, smbdev,
212 (flags & O_NONBLOCK) ? SMB_DONTWAIT : (SMB_WAIT | SMB_INTR))))
213 return (error);
214
215 switch (cmd) {
216 case SMB_QUICK_WRITE:
217 error = smbus_error(smbus_quick(parent, s->slave, SMB_QWRITE));
218 break;
219
220 case SMB_QUICK_READ:
221 error = smbus_error(smbus_quick(parent, s->slave, SMB_QREAD));
222 break;
223
224 case SMB_SENDB:
225 error = smbus_error(smbus_sendb(parent, s->slave, s->cmd));
226 break;
227
228 case SMB_RECVB:
229 error = smbus_error(smbus_recvb(parent, s->slave, &s->cmd));
230 break;
231
232 case SMB_WRITEB:
233 error = smbus_error(smbus_writeb(parent, s->slave, s->cmd,
234 s->data.byte));
235 break;
236
237 case SMB_WRITEW:
238 error = smbus_error(smbus_writew(parent, s->slave,
239 s->cmd, s->data.word));
240 break;
241
242 case SMB_READB:
243 if (s->data.byte_ptr)
244 error = smbus_error(smbus_readb(parent, s->slave,
245 s->cmd, s->data.byte_ptr));
246 break;
247
248 case SMB_READW:
249 if (s->data.word_ptr)
250 error = smbus_error(smbus_readw(parent, s->slave,
251 s->cmd, s->data.word_ptr));
252 break;
253
254 case SMB_PCALL:
255 if (s->data.process.rdata)
256 error = smbus_error(smbus_pcall(parent, s->slave, s->cmd,
257 s->data.process.sdata, s->data.process.rdata));
258 break;
259
260 case SMB_BWRITE:
261 if (s->count && s->data.byte_ptr)
262 error = smbus_error(smbus_bwrite(parent, s->slave,
263 s->cmd, s->count, s->data.byte_ptr));
264 break;
265
266 case SMB_BREAD:
267 if (s->count && s->data.byte_ptr)
268 error = smbus_error(smbus_bread(parent, s->slave,
269 s->cmd, s->count, s->data.byte_ptr));
270 break;
271
272 default:
273 error = ENODEV;
274 }
275
276 /* release the bus */
277 smbus_release_bus(parent, smbdev);
278
279 return (error);
280}
281
282DRIVER_MODULE(smb, smbus, smb_driver, smb_devclass, 0, 0);
283MODULE_DEPEND(smb, smbus, SMBUS_MINVER, SMBUS_PREFVER, SMBUS_MAXVER);
284MODULE_VERSION(smb, 1);
99};
100
101static void
102smb_identify(driver_t *driver, device_t parent)
103{
104 BUS_ADD_CHILD(parent, 0, "smb", 0);
105}
106
107static int
108smb_probe(device_t dev)
109{
110 device_set_desc(dev, "SMBus generic I/O");
111
112 return (0);
113}
114
115static int
116smb_attach(device_t dev)
117{
118 struct smb_softc *sc = (struct smb_softc *)device_get_softc(dev);
119
120 if (!sc)
121 return (ENOMEM);
122
123 bzero(sc, sizeof(struct smb_softc *));
124
125 sc->sc_devnode = make_dev(&smb_cdevsw, device_get_unit(dev),
126 UID_ROOT, GID_WHEEL,
127 0600, "smb%d", device_get_unit(dev));
128
129 return (0);
130}
131
132static int
133smb_detach(device_t dev)
134{
135 struct smb_softc *sc = (struct smb_softc *)device_get_softc(dev);
136
137 if (sc->sc_devnode)
138 destroy_dev(sc->sc_devnode);
139
140 return (0);
141}
142
143static int
144smbopen (dev_t dev, int flags, int fmt, struct thread *td)
145{
146 struct smb_softc *sc = IIC_SOFTC(minor(dev));
147
148 if (!sc)
149 return (EINVAL);
150
151 if (sc->sc_count)
152 return (EBUSY);
153
154 sc->sc_count++;
155
156 return (0);
157}
158
159static int
160smbclose(dev_t dev, int flags, int fmt, struct thread *td)
161{
162 struct smb_softc *sc = IIC_SOFTC(minor(dev));
163
164 if (!sc)
165 return (EINVAL);
166
167 if (!sc->sc_count)
168 return (EINVAL);
169
170 sc->sc_count--;
171
172 return (0);
173}
174
175static int
176smbwrite(dev_t dev, struct uio * uio, int ioflag)
177{
178 /* not supported */
179
180 return (EINVAL);
181}
182
183static int
184smbread(dev_t dev, struct uio * uio, int ioflag)
185{
186 /* not supported */
187
188 return (EINVAL);
189}
190
191static int
192smbioctl(dev_t dev, u_long cmd, caddr_t data, int flags, struct thread *td)
193{
194 device_t smbdev = IIC_DEVICE(minor(dev));
195 struct smb_softc *sc = IIC_SOFTC(minor(dev));
196 device_t parent = device_get_parent(smbdev);
197
198 int error = 0;
199 struct smbcmd *s = (struct smbcmd *)data;
200
201 if (!sc || !s)
202 return (EINVAL);
203
204 /* allocate the bus */
205 if ((error = smbus_request_bus(parent, smbdev,
206 (flags & O_NONBLOCK) ? SMB_DONTWAIT : (SMB_WAIT | SMB_INTR))))
207 return (error);
208
209 switch (cmd) {
210 case SMB_QUICK_WRITE:
211 error = smbus_error(smbus_quick(parent, s->slave, SMB_QWRITE));
212 break;
213
214 case SMB_QUICK_READ:
215 error = smbus_error(smbus_quick(parent, s->slave, SMB_QREAD));
216 break;
217
218 case SMB_SENDB:
219 error = smbus_error(smbus_sendb(parent, s->slave, s->cmd));
220 break;
221
222 case SMB_RECVB:
223 error = smbus_error(smbus_recvb(parent, s->slave, &s->cmd));
224 break;
225
226 case SMB_WRITEB:
227 error = smbus_error(smbus_writeb(parent, s->slave, s->cmd,
228 s->data.byte));
229 break;
230
231 case SMB_WRITEW:
232 error = smbus_error(smbus_writew(parent, s->slave,
233 s->cmd, s->data.word));
234 break;
235
236 case SMB_READB:
237 if (s->data.byte_ptr)
238 error = smbus_error(smbus_readb(parent, s->slave,
239 s->cmd, s->data.byte_ptr));
240 break;
241
242 case SMB_READW:
243 if (s->data.word_ptr)
244 error = smbus_error(smbus_readw(parent, s->slave,
245 s->cmd, s->data.word_ptr));
246 break;
247
248 case SMB_PCALL:
249 if (s->data.process.rdata)
250 error = smbus_error(smbus_pcall(parent, s->slave, s->cmd,
251 s->data.process.sdata, s->data.process.rdata));
252 break;
253
254 case SMB_BWRITE:
255 if (s->count && s->data.byte_ptr)
256 error = smbus_error(smbus_bwrite(parent, s->slave,
257 s->cmd, s->count, s->data.byte_ptr));
258 break;
259
260 case SMB_BREAD:
261 if (s->count && s->data.byte_ptr)
262 error = smbus_error(smbus_bread(parent, s->slave,
263 s->cmd, s->count, s->data.byte_ptr));
264 break;
265
266 default:
267 error = ENODEV;
268 }
269
270 /* release the bus */
271 smbus_release_bus(parent, smbdev);
272
273 return (error);
274}
275
276DRIVER_MODULE(smb, smbus, smb_driver, smb_devclass, 0, 0);
277MODULE_DEPEND(smb, smbus, SMBUS_MINVER, SMBUS_PREFVER, SMBUS_MAXVER);
278MODULE_VERSION(smb, 1);