FreeBSD/Linux Kernel Cross Reference
sys/pci/nfsmb.c
1 /*-
2 * Copyright (c) 2005 Ruslan Ermilov
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 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD: releng/9.2/sys/pci/nfsmb.c 202931 2010-01-24 14:57:54Z gavin $");
29
30 #include <sys/param.h>
31 #include <sys/bus.h>
32 #include <sys/kernel.h>
33 #include <sys/lock.h>
34 #include <sys/module.h>
35 #include <sys/mutex.h>
36 #include <sys/systm.h>
37
38 #include <machine/bus.h>
39 #include <machine/resource.h>
40 #include <sys/rman.h>
41
42 #include <dev/pci/pcivar.h>
43 #include <dev/pci/pcireg.h>
44
45 #include <dev/smbus/smbconf.h>
46 #include "smbus_if.h"
47
48 #define NFSMB_DEBUG(x) if (nfsmb_debug) (x)
49
50 #ifdef DEBUG
51 static int nfsmb_debug = 1;
52 #else
53 static int nfsmb_debug = 0;
54 #endif
55
56 /* NVIDIA nForce2/3/4 MCP */
57 #define NFSMB_VENDORID_NVIDIA 0x10de
58 #define NFSMB_DEVICEID_NF2_SMB 0x0064
59 #define NFSMB_DEVICEID_NF2_ULTRA_SMB 0x0084
60 #define NFSMB_DEVICEID_NF3_PRO150_SMB 0x00d4
61 #define NFSMB_DEVICEID_NF3_250GB_SMB 0x00e4
62 #define NFSMB_DEVICEID_NF4_SMB 0x0052
63 #define NFSMB_DEVICEID_NF4_04_SMB 0x0034
64 #define NFSMB_DEVICEID_NF4_51_SMB 0x0264
65 #define NFSMB_DEVICEID_NF4_55_SMB 0x0368
66 #define NFSMB_DEVICEID_NF4_61_SMB 0x03eb
67 #define NFSMB_DEVICEID_NF4_65_SMB 0x0446
68 #define NFSMB_DEVICEID_NF4_67_SMB 0x0542
69 #define NFSMB_DEVICEID_NF4_73_SMB 0x07d8
70 #define NFSMB_DEVICEID_NF4_78S_SMB 0x0752
71 #define NFSMB_DEVICEID_NF4_79_SMB 0x0aa2
72
73 /* PCI Configuration space registers */
74 #define NF2PCI_SMBASE_1 PCIR_BAR(4)
75 #define NF2PCI_SMBASE_2 PCIR_BAR(5)
76
77 /*
78 * ACPI 3.0, Chapter 12, SMBus Host Controller Interface.
79 */
80 #define SMB_PRTCL 0x00 /* protocol */
81 #define SMB_STS 0x01 /* status */
82 #define SMB_ADDR 0x02 /* address */
83 #define SMB_CMD 0x03 /* command */
84 #define SMB_DATA 0x04 /* 32 data registers */
85 #define SMB_BCNT 0x24 /* number of data bytes */
86 #define SMB_ALRM_A 0x25 /* alarm address */
87 #define SMB_ALRM_D 0x26 /* 2 bytes alarm data */
88
89 #define SMB_STS_DONE 0x80
90 #define SMB_STS_ALRM 0x40
91 #define SMB_STS_RES 0x20
92 #define SMB_STS_STATUS 0x1f
93 #define SMB_STS_OK 0x00 /* OK */
94 #define SMB_STS_UF 0x07 /* Unknown Failure */
95 #define SMB_STS_DANA 0x10 /* Device Address Not Acknowledged */
96 #define SMB_STS_DED 0x11 /* Device Error Detected */
97 #define SMB_STS_DCAD 0x12 /* Device Command Access Denied */
98 #define SMB_STS_UE 0x13 /* Unknown Error */
99 #define SMB_STS_DAD 0x17 /* Device Access Denied */
100 #define SMB_STS_T 0x18 /* Timeout */
101 #define SMB_STS_HUP 0x19 /* Host Unsupported Protocol */
102 #define SMB_STS_B 0x1A /* Busy */
103 #define SMB_STS_PEC 0x1F /* PEC (CRC-8) Error */
104
105 #define SMB_PRTCL_WRITE 0x00
106 #define SMB_PRTCL_READ 0x01
107 #define SMB_PRTCL_QUICK 0x02
108 #define SMB_PRTCL_BYTE 0x04
109 #define SMB_PRTCL_BYTE_DATA 0x06
110 #define SMB_PRTCL_WORD_DATA 0x08
111 #define SMB_PRTCL_BLOCK_DATA 0x0a
112 #define SMB_PRTCL_PROC_CALL 0x0c
113 #define SMB_PRTCL_BLOCK_PROC_CALL 0x0d
114 #define SMB_PRTCL_PEC 0x80
115
116 struct nfsmb_softc {
117 int rid;
118 struct resource *res;
119 device_t smbus;
120 device_t subdev;
121 struct mtx lock;
122 };
123
124 #define NFSMB_LOCK(nfsmb) mtx_lock(&(nfsmb)->lock)
125 #define NFSMB_UNLOCK(nfsmb) mtx_unlock(&(nfsmb)->lock)
126 #define NFSMB_LOCK_ASSERT(nfsmb) mtx_assert(&(nfsmb)->lock, MA_OWNED)
127
128 #define NFSMB_SMBINB(nfsmb, register) \
129 (bus_read_1(nfsmb->res, register))
130 #define NFSMB_SMBOUTB(nfsmb, register, value) \
131 (bus_write_1(nfsmb->res, register, value))
132
133 static int nfsmb_detach(device_t dev);
134 static int nfsmbsub_detach(device_t dev);
135
136 static int
137 nfsmbsub_probe(device_t dev)
138 {
139
140 device_set_desc(dev, "nForce2/3/4 MCP SMBus Controller");
141 return (BUS_PROBE_DEFAULT);
142 }
143
144 static int
145 nfsmb_probe(device_t dev)
146 {
147 u_int16_t vid;
148 u_int16_t did;
149
150 vid = pci_get_vendor(dev);
151 did = pci_get_device(dev);
152
153 if (vid == NFSMB_VENDORID_NVIDIA) {
154 switch(did) {
155 case NFSMB_DEVICEID_NF2_SMB:
156 case NFSMB_DEVICEID_NF2_ULTRA_SMB:
157 case NFSMB_DEVICEID_NF3_PRO150_SMB:
158 case NFSMB_DEVICEID_NF3_250GB_SMB:
159 case NFSMB_DEVICEID_NF4_SMB:
160 case NFSMB_DEVICEID_NF4_04_SMB:
161 case NFSMB_DEVICEID_NF4_51_SMB:
162 case NFSMB_DEVICEID_NF4_55_SMB:
163 case NFSMB_DEVICEID_NF4_61_SMB:
164 case NFSMB_DEVICEID_NF4_65_SMB:
165 case NFSMB_DEVICEID_NF4_67_SMB:
166 case NFSMB_DEVICEID_NF4_73_SMB:
167 case NFSMB_DEVICEID_NF4_78S_SMB:
168 case NFSMB_DEVICEID_NF4_79_SMB:
169 device_set_desc(dev, "nForce2/3/4 MCP SMBus Controller");
170 return (BUS_PROBE_DEFAULT);
171 }
172 }
173
174 return (ENXIO);
175 }
176
177 static int
178 nfsmbsub_attach(device_t dev)
179 {
180 device_t parent;
181 struct nfsmb_softc *nfsmbsub_sc = device_get_softc(dev);
182
183 parent = device_get_parent(dev);
184
185 nfsmbsub_sc->rid = NF2PCI_SMBASE_2;
186
187 nfsmbsub_sc->res = bus_alloc_resource_any(parent, SYS_RES_IOPORT,
188 &nfsmbsub_sc->rid, RF_ACTIVE);
189 if (nfsmbsub_sc->res == NULL) {
190 /* Older incarnations of the device used non-standard BARs. */
191 nfsmbsub_sc->rid = 0x54;
192 nfsmbsub_sc->res = bus_alloc_resource_any(parent,
193 SYS_RES_IOPORT, &nfsmbsub_sc->rid, RF_ACTIVE);
194 if (nfsmbsub_sc->res == NULL) {
195 device_printf(dev, "could not map i/o space\n");
196 return (ENXIO);
197 }
198 }
199 mtx_init(&nfsmbsub_sc->lock, device_get_nameunit(dev), "nfsmb",
200 MTX_DEF);
201
202 nfsmbsub_sc->smbus = device_add_child(dev, "smbus", -1);
203 if (nfsmbsub_sc->smbus == NULL) {
204 nfsmbsub_detach(dev);
205 return (EINVAL);
206 }
207
208 bus_generic_attach(dev);
209
210 return (0);
211 }
212
213 static int
214 nfsmb_attach(device_t dev)
215 {
216 struct nfsmb_softc *nfsmb_sc = device_get_softc(dev);
217
218 /* Allocate I/O space */
219 nfsmb_sc->rid = NF2PCI_SMBASE_1;
220
221 nfsmb_sc->res = bus_alloc_resource_any(dev, SYS_RES_IOPORT,
222 &nfsmb_sc->rid, RF_ACTIVE);
223
224 if (nfsmb_sc->res == NULL) {
225 /* Older incarnations of the device used non-standard BARs. */
226 nfsmb_sc->rid = 0x50;
227 nfsmb_sc->res = bus_alloc_resource_any(dev,
228 SYS_RES_IOPORT, &nfsmb_sc->rid, RF_ACTIVE);
229 if (nfsmb_sc->res == NULL) {
230 device_printf(dev, "could not map i/o space\n");
231 return (ENXIO);
232 }
233 }
234
235 mtx_init(&nfsmb_sc->lock, device_get_nameunit(dev), "nfsmb", MTX_DEF);
236
237 /* Allocate a new smbus device */
238 nfsmb_sc->smbus = device_add_child(dev, "smbus", -1);
239 if (!nfsmb_sc->smbus) {
240 nfsmb_detach(dev);
241 return (EINVAL);
242 }
243
244 nfsmb_sc->subdev = NULL;
245 switch (pci_get_device(dev)) {
246 case NFSMB_DEVICEID_NF2_SMB:
247 case NFSMB_DEVICEID_NF2_ULTRA_SMB:
248 case NFSMB_DEVICEID_NF3_PRO150_SMB:
249 case NFSMB_DEVICEID_NF3_250GB_SMB:
250 case NFSMB_DEVICEID_NF4_SMB:
251 case NFSMB_DEVICEID_NF4_04_SMB:
252 case NFSMB_DEVICEID_NF4_51_SMB:
253 case NFSMB_DEVICEID_NF4_55_SMB:
254 case NFSMB_DEVICEID_NF4_61_SMB:
255 case NFSMB_DEVICEID_NF4_65_SMB:
256 case NFSMB_DEVICEID_NF4_67_SMB:
257 case NFSMB_DEVICEID_NF4_73_SMB:
258 case NFSMB_DEVICEID_NF4_78S_SMB:
259 case NFSMB_DEVICEID_NF4_79_SMB:
260 /* Trying to add secondary device as slave */
261 nfsmb_sc->subdev = device_add_child(dev, "nfsmb", -1);
262 if (!nfsmb_sc->subdev) {
263 nfsmb_detach(dev);
264 return (EINVAL);
265 }
266 break;
267 default:
268 break;
269 }
270
271 bus_generic_attach(dev);
272
273 return (0);
274 }
275
276 static int
277 nfsmbsub_detach(device_t dev)
278 {
279 device_t parent;
280 struct nfsmb_softc *nfsmbsub_sc = device_get_softc(dev);
281
282 parent = device_get_parent(dev);
283
284 if (nfsmbsub_sc->smbus) {
285 device_delete_child(dev, nfsmbsub_sc->smbus);
286 nfsmbsub_sc->smbus = NULL;
287 }
288 mtx_destroy(&nfsmbsub_sc->lock);
289 if (nfsmbsub_sc->res) {
290 bus_release_resource(parent, SYS_RES_IOPORT, nfsmbsub_sc->rid,
291 nfsmbsub_sc->res);
292 nfsmbsub_sc->res = NULL;
293 }
294 return (0);
295 }
296
297 static int
298 nfsmb_detach(device_t dev)
299 {
300 struct nfsmb_softc *nfsmb_sc = device_get_softc(dev);
301
302 if (nfsmb_sc->subdev) {
303 device_delete_child(dev, nfsmb_sc->subdev);
304 nfsmb_sc->subdev = NULL;
305 }
306
307 if (nfsmb_sc->smbus) {
308 device_delete_child(dev, nfsmb_sc->smbus);
309 nfsmb_sc->smbus = NULL;
310 }
311
312 mtx_destroy(&nfsmb_sc->lock);
313 if (nfsmb_sc->res) {
314 bus_release_resource(dev, SYS_RES_IOPORT, nfsmb_sc->rid,
315 nfsmb_sc->res);
316 nfsmb_sc->res = NULL;
317 }
318
319 return (0);
320 }
321
322 static int
323 nfsmb_callback(device_t dev, int index, void *data)
324 {
325 int error = 0;
326
327 switch (index) {
328 case SMB_REQUEST_BUS:
329 case SMB_RELEASE_BUS:
330 break;
331 default:
332 error = EINVAL;
333 }
334
335 return (error);
336 }
337
338 static int
339 nfsmb_wait(struct nfsmb_softc *sc)
340 {
341 u_char sts;
342 int error, count;
343
344 NFSMB_LOCK_ASSERT(sc);
345 if (NFSMB_SMBINB(sc, SMB_PRTCL) != 0)
346 {
347 count = 10000;
348 do {
349 DELAY(500);
350 } while (NFSMB_SMBINB(sc, SMB_PRTCL) != 0 && count--);
351 if (count == 0)
352 return (SMB_ETIMEOUT);
353 }
354
355 sts = NFSMB_SMBINB(sc, SMB_STS) & SMB_STS_STATUS;
356 NFSMB_DEBUG(printf("nfsmb: STS=0x%x\n", sts));
357
358 switch (sts) {
359 case SMB_STS_OK:
360 error = SMB_ENOERR;
361 break;
362 case SMB_STS_DANA:
363 error = SMB_ENOACK;
364 break;
365 case SMB_STS_B:
366 error = SMB_EBUSY;
367 break;
368 case SMB_STS_T:
369 error = SMB_ETIMEOUT;
370 break;
371 case SMB_STS_DCAD:
372 case SMB_STS_DAD:
373 case SMB_STS_HUP:
374 error = SMB_ENOTSUPP;
375 break;
376 default:
377 error = SMB_EBUSERR;
378 break;
379 }
380
381 return (error);
382 }
383
384 static int
385 nfsmb_quick(device_t dev, u_char slave, int how)
386 {
387 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
388 u_char protocol;
389 int error;
390
391 protocol = SMB_PRTCL_QUICK;
392
393 switch (how) {
394 case SMB_QWRITE:
395 protocol |= SMB_PRTCL_WRITE;
396 NFSMB_DEBUG(printf("nfsmb: QWRITE to 0x%x", slave));
397 break;
398 case SMB_QREAD:
399 protocol |= SMB_PRTCL_READ;
400 NFSMB_DEBUG(printf("nfsmb: QREAD to 0x%x", slave));
401 break;
402 default:
403 panic("%s: unknown QUICK command (%x)!", __func__, how);
404 }
405
406 NFSMB_LOCK(sc);
407 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
408 NFSMB_SMBOUTB(sc, SMB_PRTCL, protocol);
409
410 error = nfsmb_wait(sc);
411
412 NFSMB_DEBUG(printf(", error=0x%x\n", error));
413 NFSMB_UNLOCK(sc);
414
415 return (error);
416 }
417
418 static int
419 nfsmb_sendb(device_t dev, u_char slave, char byte)
420 {
421 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
422 int error;
423
424 NFSMB_LOCK(sc);
425 NFSMB_SMBOUTB(sc, SMB_CMD, byte);
426 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
427 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_WRITE | SMB_PRTCL_BYTE);
428
429 error = nfsmb_wait(sc);
430
431 NFSMB_DEBUG(printf("nfsmb: SENDB to 0x%x, byte=0x%x, error=0x%x\n", slave, byte, error));
432 NFSMB_UNLOCK(sc);
433
434 return (error);
435 }
436
437 static int
438 nfsmb_recvb(device_t dev, u_char slave, char *byte)
439 {
440 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
441 int error;
442
443 NFSMB_LOCK(sc);
444 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
445 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_READ | SMB_PRTCL_BYTE);
446
447 if ((error = nfsmb_wait(sc)) == SMB_ENOERR)
448 *byte = NFSMB_SMBINB(sc, SMB_DATA);
449
450 NFSMB_DEBUG(printf("nfsmb: RECVB from 0x%x, byte=0x%x, error=0x%x\n", slave, *byte, error));
451 NFSMB_UNLOCK(sc);
452
453 return (error);
454 }
455
456 static int
457 nfsmb_writeb(device_t dev, u_char slave, char cmd, char byte)
458 {
459 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
460 int error;
461
462 NFSMB_LOCK(sc);
463 NFSMB_SMBOUTB(sc, SMB_CMD, cmd);
464 NFSMB_SMBOUTB(sc, SMB_DATA, byte);
465 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
466 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_WRITE | SMB_PRTCL_BYTE_DATA);
467
468 error = nfsmb_wait(sc);
469
470 NFSMB_DEBUG(printf("nfsmb: WRITEB to 0x%x, cmd=0x%x, byte=0x%x, error=0x%x\n", slave, cmd, byte, error));
471 NFSMB_UNLOCK(sc);
472
473 return (error);
474 }
475
476 static int
477 nfsmb_readb(device_t dev, u_char slave, char cmd, char *byte)
478 {
479 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
480 int error;
481
482 NFSMB_LOCK(sc);
483 NFSMB_SMBOUTB(sc, SMB_CMD, cmd);
484 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
485 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_READ | SMB_PRTCL_BYTE_DATA);
486
487 if ((error = nfsmb_wait(sc)) == SMB_ENOERR)
488 *byte = NFSMB_SMBINB(sc, SMB_DATA);
489
490 NFSMB_DEBUG(printf("nfsmb: READB from 0x%x, cmd=0x%x, byte=0x%x, error=0x%x\n", slave, cmd, (unsigned char)*byte, error));
491 NFSMB_UNLOCK(sc);
492
493 return (error);
494 }
495
496 static int
497 nfsmb_writew(device_t dev, u_char slave, char cmd, short word)
498 {
499 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
500 int error;
501
502 NFSMB_LOCK(sc);
503 NFSMB_SMBOUTB(sc, SMB_CMD, cmd);
504 NFSMB_SMBOUTB(sc, SMB_DATA, word);
505 NFSMB_SMBOUTB(sc, SMB_DATA + 1, word >> 8);
506 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
507 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_WRITE | SMB_PRTCL_WORD_DATA);
508
509 error = nfsmb_wait(sc);
510
511 NFSMB_DEBUG(printf("nfsmb: WRITEW to 0x%x, cmd=0x%x, word=0x%x, error=0x%x\n", slave, cmd, word, error));
512 NFSMB_UNLOCK(sc);
513
514 return (error);
515 }
516
517 static int
518 nfsmb_readw(device_t dev, u_char slave, char cmd, short *word)
519 {
520 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
521 int error;
522
523 NFSMB_LOCK(sc);
524 NFSMB_SMBOUTB(sc, SMB_CMD, cmd);
525 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
526 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_READ | SMB_PRTCL_WORD_DATA);
527
528 if ((error = nfsmb_wait(sc)) == SMB_ENOERR)
529 *word = NFSMB_SMBINB(sc, SMB_DATA) |
530 (NFSMB_SMBINB(sc, SMB_DATA + 1) << 8);
531
532 NFSMB_DEBUG(printf("nfsmb: READW from 0x%x, cmd=0x%x, word=0x%x, error=0x%x\n", slave, cmd, (unsigned short)*word, error));
533 NFSMB_UNLOCK(sc);
534
535 return (error);
536 }
537
538 static int
539 nfsmb_bwrite(device_t dev, u_char slave, char cmd, u_char count, char *buf)
540 {
541 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
542 u_char i;
543 int error;
544
545 if (count < 1 || count > 32)
546 return (SMB_EINVAL);
547
548 NFSMB_LOCK(sc);
549 NFSMB_SMBOUTB(sc, SMB_CMD, cmd);
550 NFSMB_SMBOUTB(sc, SMB_BCNT, count);
551 for (i = 0; i < count; i++)
552 NFSMB_SMBOUTB(sc, SMB_DATA + i, buf[i]);
553 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
554 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_WRITE | SMB_PRTCL_BLOCK_DATA);
555
556 error = nfsmb_wait(sc);
557
558 NFSMB_DEBUG(printf("nfsmb: WRITEBLK to 0x%x, count=0x%x, cmd=0x%x, error=0x%x", slave, count, cmd, error));
559 NFSMB_UNLOCK(sc);
560
561 return (error);
562 }
563
564 static int
565 nfsmb_bread(device_t dev, u_char slave, char cmd, u_char *count, char *buf)
566 {
567 struct nfsmb_softc *sc = (struct nfsmb_softc *)device_get_softc(dev);
568 u_char data, len, i;
569 int error;
570
571 if (*count < 1 || *count > 32)
572 return (SMB_EINVAL);
573
574 NFSMB_LOCK(sc);
575 NFSMB_SMBOUTB(sc, SMB_CMD, cmd);
576 NFSMB_SMBOUTB(sc, SMB_ADDR, slave);
577 NFSMB_SMBOUTB(sc, SMB_PRTCL, SMB_PRTCL_READ | SMB_PRTCL_BLOCK_DATA);
578
579 if ((error = nfsmb_wait(sc)) == SMB_ENOERR) {
580 len = NFSMB_SMBINB(sc, SMB_BCNT);
581 for (i = 0; i < len; i++) {
582 data = NFSMB_SMBINB(sc, SMB_DATA + i);
583 if (i < *count)
584 buf[i] = data;
585 }
586 *count = len;
587 }
588
589 NFSMB_DEBUG(printf("nfsmb: READBLK to 0x%x, count=0x%x, cmd=0x%x, error=0x%x", slave, *count, cmd, error));
590 NFSMB_UNLOCK(sc);
591
592 return (error);
593 }
594
595 static device_method_t nfsmb_methods[] = {
596 /* Device interface */
597 DEVMETHOD(device_probe, nfsmb_probe),
598 DEVMETHOD(device_attach, nfsmb_attach),
599 DEVMETHOD(device_detach, nfsmb_detach),
600
601 /* SMBus interface */
602 DEVMETHOD(smbus_callback, nfsmb_callback),
603 DEVMETHOD(smbus_quick, nfsmb_quick),
604 DEVMETHOD(smbus_sendb, nfsmb_sendb),
605 DEVMETHOD(smbus_recvb, nfsmb_recvb),
606 DEVMETHOD(smbus_writeb, nfsmb_writeb),
607 DEVMETHOD(smbus_readb, nfsmb_readb),
608 DEVMETHOD(smbus_writew, nfsmb_writew),
609 DEVMETHOD(smbus_readw, nfsmb_readw),
610 DEVMETHOD(smbus_bwrite, nfsmb_bwrite),
611 DEVMETHOD(smbus_bread, nfsmb_bread),
612
613 { 0, 0 }
614 };
615
616 static device_method_t nfsmbsub_methods[] = {
617 /* Device interface */
618 DEVMETHOD(device_probe, nfsmbsub_probe),
619 DEVMETHOD(device_attach, nfsmbsub_attach),
620 DEVMETHOD(device_detach, nfsmbsub_detach),
621
622 /* SMBus interface */
623 DEVMETHOD(smbus_callback, nfsmb_callback),
624 DEVMETHOD(smbus_quick, nfsmb_quick),
625 DEVMETHOD(smbus_sendb, nfsmb_sendb),
626 DEVMETHOD(smbus_recvb, nfsmb_recvb),
627 DEVMETHOD(smbus_writeb, nfsmb_writeb),
628 DEVMETHOD(smbus_readb, nfsmb_readb),
629 DEVMETHOD(smbus_writew, nfsmb_writew),
630 DEVMETHOD(smbus_readw, nfsmb_readw),
631 DEVMETHOD(smbus_bwrite, nfsmb_bwrite),
632 DEVMETHOD(smbus_bread, nfsmb_bread),
633
634 { 0, 0 }
635 };
636
637 static devclass_t nfsmb_devclass;
638
639 static driver_t nfsmb_driver = {
640 "nfsmb",
641 nfsmb_methods,
642 sizeof(struct nfsmb_softc),
643 };
644
645 static driver_t nfsmbsub_driver = {
646 "nfsmb",
647 nfsmbsub_methods,
648 sizeof(struct nfsmb_softc),
649 };
650
651 DRIVER_MODULE(nfsmb, pci, nfsmb_driver, nfsmb_devclass, 0, 0);
652 DRIVER_MODULE(nfsmb, nfsmb, nfsmbsub_driver, nfsmb_devclass, 0, 0);
653 DRIVER_MODULE(smbus, nfsmb, smbus_driver, smbus_devclass, 0, 0);
654
655 MODULE_DEPEND(nfsmb, pci, 1, 1, 1);
656 MODULE_DEPEND(nfsmb, smbus, SMBUS_MINVER, SMBUS_PREFVER, SMBUS_MAXVER);
657 MODULE_VERSION(nfsmb, 1);
Cache object: 78c5eee2cea7962795b16b394ae602ec
|