ii_pci20kc.c revision 3555a4c35e59c0217983f5df0cfe39a9fa65c2df
1/* 2 * comedi/drivers/ii_pci20kc.c 3 * Driver for Intelligent Instruments PCI-20001C carrier board 4 * and modules. 5 * 6 * Copyright (C) 2000 Markus Kempf <kempf@matsci.uni-sb.de> 7 * with suggestions from David Schleef 8 * 16.06.2000 9 * 10 * Linux device driver for COMEDI 11 * Intelligent Instrumentation 12 * PCI-20001 C-2A Carrier Board 13 * PCI-20341 M-1A 16-Bit analog input module 14 * - differential 15 * - range (-5V - +5V) 16 * - 16 bit 17 * PCI-20006 M-2 16-Bit analog output module 18 * - ranges (-10V - +10V) (0V - +10V) (-5V - +5V) 19 * - 16 bit 20 * 21 * only ONE PCI-20341 module possible 22 * only ONE PCI-20006 module possible 23 * no extern trigger implemented 24 * 25 * NOT WORKING (but soon) only 4 on-board differential channels supported 26 * NOT WORKING (but soon) only ONE di-port and ONE do-port supported 27 * instead of 4 digital ports 28 * di-port == Port 0 29 * do-port == Port 1 30 * 31 * The state of this driver is only a starting point for a complete 32 * COMEDI-driver. The final driver should support all features of the 33 * carrier board and modules. 34 * 35 * The test configuration: 36 * 37 * kernel 2.2.14 with RTAI v1.2 and patch-2.2.14rthal2 38 * COMEDI 0.7.45 39 * COMEDILIB 0.7.9 40 * 41 */ 42/* 43Driver: ii_pci20kc 44Description: Intelligent Instruments PCI-20001C carrier board 45Author: Markus Kempf <kempf@matsci.uni-sb.de> 46Devices: [Intelligent Instrumentation] PCI-20001C (ii_pci20kc) 47Status: works 48 49Supports the PCI-20001 C-2a Carrier board, and could probably support 50the other carrier boards with small modifications. Modules supported 51are: 52 PCI-20006 M-2 16-bit analog output module 53 PCI-20341 M-1A 16-bit analog input module 54 55Options: 56 0 Board base address 57 1 IRQ 58 2 first option for module 1 59 3 second option for module 1 60 4 first option for module 2 61 5 second option for module 2 62 6 first option for module 3 63 7 second option for module 3 64 65options for PCI-20006M: 66 first: Analog output channel 0 range configuration 67 0 bipolar 10 (-10V -- +10V) 68 1 unipolar 10 (0V -- +10V) 69 2 bipolar 5 (-5V -- 5V) 70 second: Analog output channel 1 range configuration 71 72options for PCI-20341M: 73 first: Analog input gain configuration 74 0 1 75 1 10 76 2 100 77 3 200 78*/ 79 80/* XXX needs to use ioremap() for compatibility with 2.4 kernels. Should also 81 * check_mem_region() etc. - fmhess */ 82 83#include "../comedidev.h" 84 85#define PCI20000_ID 0x1d 86#define PCI20341_ID 0x77 87#define PCI20006_ID 0xe3 88#define PCI20xxx_EMPTY_ID 0xff 89 90#define PCI20000_OFFSET 0x100 91#define PCI20000_MODULES 3 92 93#define PCI20000_DIO_0 0x80 94#define PCI20000_DIO_1 0x81 95#define PCI20000_DIO_2 0xc0 96#define PCI20000_DIO_3 0xc1 97#define PCI20000_DIO_CONTROL_01 0x83 /* port 0, 1 control */ 98#define PCI20000_DIO_CONTROL_23 0xc3 /* port 2, 3 control */ 99#define PCI20000_DIO_BUFFER 0x82 /* buffer direction & enable */ 100#define PCI20000_DIO_EOC 0xef /* even port, control output */ 101#define PCI20000_DIO_OOC 0xfd /* odd port, control output */ 102#define PCI20000_DIO_EIC 0x90 /* even port, control input */ 103#define PCI20000_DIO_OIC 0x82 /* odd port, control input */ 104#define DIO_CAND 0x12 /* and bit 1 & 4 of control */ 105#define DIO_BE 0x01 /* buffer: port enable */ 106#define DIO_BO 0x04 /* buffer: output */ 107#define DIO_BI 0x05 /* buffer: input */ 108#define DIO_PS_0 0x00 /* buffer: port shift 0 */ 109#define DIO_PS_1 0x01 /* buffer: port shift 1 */ 110#define DIO_PS_2 0x04 /* buffer: port shift 2 */ 111#define DIO_PS_3 0x05 /* buffer: port shift 3 */ 112 113#define PCI20006_LCHAN0 0x0d 114#define PCI20006_STROBE0 0x0b 115#define PCI20006_LCHAN1 0x15 116#define PCI20006_STROBE1 0x13 117 118#define PCI20341_INIT 0x04 119#define PCI20341_REPMODE 0x00 /* single shot mode */ 120#define PCI20341_PACER 0x00 /* Hardware Pacer disabled */ 121#define PCI20341_CHAN_NR 0x04 /* number of input channels */ 122#define PCI20341_CONFIG_REG 0x10 123#define PCI20341_MOD_STATUS 0x01 124#define PCI20341_OPT_REG 0x11 125#define PCI20341_SET_TIME_REG 0x15 126#define PCI20341_LCHAN_ADDR_REG 0x13 127#define PCI20341_CHAN_LIST 0x80 128#define PCI20341_CC_RESET 0x1b 129#define PCI20341_CHAN_RESET 0x19 130#define PCI20341_SOFT_PACER 0x04 131#define PCI20341_STATUS_REG 0x12 132#define PCI20341_LDATA 0x02 133#define PCI20341_DAISY_CHAIN 0x20 /* On-board inputs only */ 134#define PCI20341_MUX 0x04 /* Enable on-board MUX */ 135#define PCI20341_SCANLIST 0x80 /* Channel/Gain Scan List */ 136 137union pci20xxx_subdev_private { 138 void *iobase; 139 struct { 140 void *iobase; 141 const struct comedi_lrange *ao_range_list[2]; 142 /* range of channels of ao module */ 143 unsigned int last_data[2]; 144 } pci20006; 145 struct { 146 void *iobase; 147 int timebase; 148 int settling_time; 149 int ai_gain; 150 } pci20341; 151}; 152 153struct pci20xxx_private { 154 155 void *ioaddr; 156 union pci20xxx_subdev_private subdev_private[PCI20000_MODULES]; 157}; 158 159#define devpriv ((struct pci20xxx_private *)dev->private) 160#define CHAN (CR_CHAN(it->chanlist[0])) 161 162static int pci20xxx_attach(struct comedi_device *dev, 163 struct comedi_devconfig *it); 164static int pci20xxx_detach(struct comedi_device *dev); 165 166static struct comedi_driver driver_pci20xxx = { 167 .driver_name = "ii_pci20kc", 168 .module = THIS_MODULE, 169 .attach = pci20xxx_attach, 170 .detach = pci20xxx_detach, 171}; 172 173static int pci20006_init(struct comedi_device *dev, struct comedi_subdevice *s, 174 int opt0, int opt1); 175static int pci20341_init(struct comedi_device *dev, struct comedi_subdevice *s, 176 int opt0, int opt1); 177static int pci20xxx_dio_init(struct comedi_device *dev, 178 struct comedi_subdevice *s); 179 180/* 181 options[0] Board base address 182 options[1] IRQ 183 options[2] first option for module 1 184 options[3] second option for module 1 185 options[4] first option for module 2 186 options[5] second option for module 2 187 options[6] first option for module 3 188 options[7] second option for module 3 189 190 options for PCI-20341M: 191 first Analog input gain configuration 192 0 == 1 193 1 == 10 194 2 == 100 195 3 == 200 196 197 options for PCI-20006M: 198 first Analog output channel 0 range configuration 199 0 == bipolar 10 (-10V -- +10V) 200 1 == unipolar 10V (0V -- +10V) 201 2 == bipolar 5V (-5V -- +5V) 202 second Analog output channel 1 range configuration 203 0 == bipolar 10 (-10V -- +10V) 204 1 == unipolar 10V (0V -- +10V) 205 2 == bipolar 5V (-5V -- +5V) 206*/ 207static int pci20xxx_attach(struct comedi_device *dev, 208 struct comedi_devconfig *it) 209{ 210 unsigned char i; 211 int ret; 212 int id; 213 struct comedi_subdevice *s; 214 union pci20xxx_subdev_private *sdp; 215 216 ret = alloc_subdevices(dev, 1 + PCI20000_MODULES); 217 if (ret < 0) 218 return ret; 219 220 ret = alloc_private(dev, sizeof(struct pci20xxx_private)); 221 if (ret < 0) 222 return ret; 223 224 devpriv->ioaddr = (void *)(unsigned long)it->options[0]; 225 dev->board_name = "pci20kc"; 226 227 /* Check PCI-20001 C-2A Carrier Board ID */ 228 if ((readb(devpriv->ioaddr) & PCI20000_ID) != PCI20000_ID) { 229 printk(KERN_WARNING "comedi%d: ii_pci20kc PCI-20001" 230 " C-2A Carrier Board at base=0x%p not found !\n", 231 dev->minor, devpriv->ioaddr); 232 return -EINVAL; 233 } 234 printk(KERN_INFO "comedi%d: ii_pci20kc: PCI-20001 C-2A at base=0x%p\n", 235 dev->minor, devpriv->ioaddr); 236 237 for (i = 0; i < PCI20000_MODULES; i++) { 238 s = dev->subdevices + i; 239 id = readb(devpriv->ioaddr + (i + 1) * PCI20000_OFFSET); 240 s->private = devpriv->subdev_private + i; 241 sdp = s->private; 242 switch (id) { 243 case PCI20006_ID: 244 sdp->pci20006.iobase = 245 devpriv->ioaddr + (i + 1) * PCI20000_OFFSET; 246 pci20006_init(dev, s, it->options[2 * i + 2], 247 it->options[2 * i + 3]); 248 printk(KERN_INFO "comedi%d: " 249 "ii_pci20kc PCI-20006 module in slot %d\n", 250 dev->minor, i + 1); 251 break; 252 case PCI20341_ID: 253 sdp->pci20341.iobase = 254 devpriv->ioaddr + (i + 1) * PCI20000_OFFSET; 255 pci20341_init(dev, s, it->options[2 * i + 2], 256 it->options[2 * i + 3]); 257 printk(KERN_INFO "comedi%d: " 258 "ii_pci20kc PCI-20341 module in slot %d\n", 259 dev->minor, i + 1); 260 break; 261 default: 262 printk(KERN_WARNING "ii_pci20kc: unknown module " 263 "code 0x%02x in slot %d: module disabled\n", 264 id, i); /* XXX this looks like a bug! i + 1 ?? */ 265 /* fall through */ 266 case PCI20xxx_EMPTY_ID: 267 s->type = COMEDI_SUBD_UNUSED; 268 break; 269 } 270 } 271 272 /* initialize struct pci20xxx_private */ 273 pci20xxx_dio_init(dev, dev->subdevices + PCI20000_MODULES); 274 275 return 1; 276} 277 278static int pci20xxx_detach(struct comedi_device *dev) 279{ 280 printk(KERN_INFO "comedi%d: pci20xxx: remove\n", dev->minor); 281 282 return 0; 283} 284 285/* pci20006m */ 286 287static int pci20006_insn_read(struct comedi_device *dev, 288 struct comedi_subdevice *s, 289 struct comedi_insn *insn, unsigned int *data); 290static int pci20006_insn_write(struct comedi_device *dev, 291 struct comedi_subdevice *s, 292 struct comedi_insn *insn, unsigned int *data); 293 294static const struct comedi_lrange *pci20006_range_list[] = { 295 &range_bipolar10, 296 &range_unipolar10, 297 &range_bipolar5, 298}; 299 300static int pci20006_init(struct comedi_device *dev, struct comedi_subdevice *s, 301 int opt0, int opt1) 302{ 303 union pci20xxx_subdev_private *sdp = s->private; 304 305 if (opt0 < 0 || opt0 > 2) 306 opt0 = 0; 307 if (opt1 < 0 || opt1 > 2) 308 opt1 = 0; 309 310 sdp->pci20006.ao_range_list[0] = pci20006_range_list[opt0]; 311 sdp->pci20006.ao_range_list[1] = pci20006_range_list[opt1]; 312 313 /* ao subdevice */ 314 s->type = COMEDI_SUBD_AO; 315 s->subdev_flags = SDF_WRITABLE; 316 s->n_chan = 2; 317 s->len_chanlist = 2; 318 s->insn_read = pci20006_insn_read; 319 s->insn_write = pci20006_insn_write; 320 s->maxdata = 0xffff; 321 s->range_table_list = sdp->pci20006.ao_range_list; 322 return 0; 323} 324 325static int pci20006_insn_read(struct comedi_device *dev, 326 struct comedi_subdevice *s, 327 struct comedi_insn *insn, unsigned int *data) 328{ 329 union pci20xxx_subdev_private *sdp = s->private; 330 331 data[0] = sdp->pci20006.last_data[CR_CHAN(insn->chanspec)]; 332 333 return 1; 334} 335 336static int pci20006_insn_write(struct comedi_device *dev, 337 struct comedi_subdevice *s, 338 struct comedi_insn *insn, unsigned int *data) 339{ 340 union pci20xxx_subdev_private *sdp = s->private; 341 int hi, lo; 342 unsigned int boarddata; 343 344 sdp->pci20006.last_data[CR_CHAN(insn->chanspec)] = data[0]; 345 boarddata = (((unsigned int)data[0] + 0x8000) & 0xffff); 346 /* comedi-data -> board-data */ 347 lo = (boarddata & 0xff); 348 hi = ((boarddata >> 8) & 0xff); 349 350 switch (CR_CHAN(insn->chanspec)) { 351 case 0: 352 writeb(lo, sdp->iobase + PCI20006_LCHAN0); 353 writeb(hi, sdp->iobase + PCI20006_LCHAN0 + 1); 354 writeb(0x00, sdp->iobase + PCI20006_STROBE0); 355 break; 356 case 1: 357 writeb(lo, sdp->iobase + PCI20006_LCHAN1); 358 writeb(hi, sdp->iobase + PCI20006_LCHAN1 + 1); 359 writeb(0x00, sdp->iobase + PCI20006_STROBE1); 360 break; 361 default: 362 printk(KERN_WARNING 363 " comedi%d: pci20xxx: ao channel Error!\n", dev->minor); 364 return -EINVAL; 365 } 366 367 return 1; 368} 369 370/* PCI20341M */ 371 372static int pci20341_insn_read(struct comedi_device *dev, 373 struct comedi_subdevice *s, 374 struct comedi_insn *insn, unsigned int *data); 375 376static const int pci20341_timebase[] = { 0x00, 0x00, 0x00, 0x04 }; 377static const int pci20341_settling_time[] = { 0x58, 0x58, 0x93, 0x99 }; 378 379static const struct comedi_lrange range_bipolar0_5 = { 380 1, 381 {BIP_RANGE(0.5)} 382}; 383 384static const struct comedi_lrange range_bipolar0_05 = { 385 1, 386 {BIP_RANGE(0.05)} 387}; 388 389static const struct comedi_lrange range_bipolar0_025 = { 390 1, 391 {BIP_RANGE(0.025)} 392}; 393 394static const struct comedi_lrange *const pci20341_ranges[] = { 395 &range_bipolar5, 396 &range_bipolar0_5, 397 &range_bipolar0_05, 398 &range_bipolar0_025, 399}; 400 401static int pci20341_init(struct comedi_device *dev, struct comedi_subdevice *s, 402 int opt0, int opt1) 403{ 404 union pci20xxx_subdev_private *sdp = s->private; 405 int option; 406 407 /* options handling */ 408 if (opt0 < 0 || opt0 > 3) 409 opt0 = 0; 410 sdp->pci20341.timebase = pci20341_timebase[opt0]; 411 sdp->pci20341.settling_time = pci20341_settling_time[opt0]; 412 413 /* ai subdevice */ 414 s->type = COMEDI_SUBD_AI; 415 s->subdev_flags = SDF_READABLE; 416 s->n_chan = PCI20341_CHAN_NR; 417 s->len_chanlist = PCI20341_SCANLIST; 418 s->insn_read = pci20341_insn_read; 419 s->maxdata = 0xffff; 420 s->range_table = pci20341_ranges[opt0]; 421 422 /* depends on gain, trigger, repetition mode */ 423 option = sdp->pci20341.timebase | PCI20341_REPMODE; 424 425 /* initialize Module */ 426 writeb(PCI20341_INIT, sdp->iobase + PCI20341_CONFIG_REG); 427 /* set Pacer */ 428 writeb(PCI20341_PACER, sdp->iobase + PCI20341_MOD_STATUS); 429 /* option register */ 430 writeb(option, sdp->iobase + PCI20341_OPT_REG); 431 /* settling time counter */ 432 writeb(sdp->pci20341.settling_time, 433 sdp->iobase + PCI20341_SET_TIME_REG); 434 /* trigger not implemented */ 435 return 0; 436} 437 438static int pci20341_insn_read(struct comedi_device *dev, 439 struct comedi_subdevice *s, 440 struct comedi_insn *insn, unsigned int *data) 441{ 442 union pci20xxx_subdev_private *sdp = s->private; 443 unsigned int i = 0, j = 0; 444 int lo, hi; 445 unsigned char eoc; /* end of conversion */ 446 unsigned int clb; /* channel list byte */ 447 unsigned int boarddata; 448 449 /* write number of input channels */ 450 writeb(1, sdp->iobase + PCI20341_LCHAN_ADDR_REG); 451 clb = PCI20341_DAISY_CHAIN | PCI20341_MUX | (sdp->pci20341.ai_gain << 3) 452 | CR_CHAN(insn->chanspec); 453 writeb(clb, sdp->iobase + PCI20341_CHAN_LIST); 454 455 /* reset settling time counter and trigger delay counter */ 456 writeb(0x00, sdp->iobase + PCI20341_CC_RESET); 457 458 writeb(0x00, sdp->iobase + PCI20341_CHAN_RESET); 459 460 /* generate Pacer */ 461 462 for (i = 0; i < insn->n; i++) { 463 /* data polling isn't the niciest way to get the data, I know, 464 * but there are only 6 cycles (mean) and it is easier than 465 * the whole interrupt stuff 466 */ 467 j = 0; 468 /* generate Pacer */ 469 readb(sdp->iobase + PCI20341_SOFT_PACER); 470 471 eoc = readb(sdp->iobase + PCI20341_STATUS_REG); 472 /* poll Interrupt Flag */ 473 while ((eoc < 0x80) && j < 100) { 474 j++; 475 eoc = readb(sdp->iobase + PCI20341_STATUS_REG); 476 } 477 if (j >= 100) { 478 printk(KERN_WARNING 479 "comedi%d: pci20xxx: " 480 "AI interrupt channel %i polling exit !\n", 481 dev->minor, i); 482 return -EINVAL; 483 } 484 lo = readb(sdp->iobase + PCI20341_LDATA); 485 hi = readb(sdp->iobase + PCI20341_LDATA + 1); 486 boarddata = lo + 0x100 * hi; 487 488 /* board-data -> comedi-data */ 489 data[i] = (short)((boarddata + 0x8000) & 0xffff); 490 } 491 492 return i; 493} 494 495/* native DIO */ 496 497static void pci20xxx_dio_config(struct comedi_device *dev, 498 struct comedi_subdevice *s); 499static int pci20xxx_dio_insn_bits(struct comedi_device *dev, 500 struct comedi_subdevice *s, 501 struct comedi_insn *insn, unsigned int *data); 502static int pci20xxx_dio_insn_config(struct comedi_device *dev, 503 struct comedi_subdevice *s, 504 struct comedi_insn *insn, 505 unsigned int *data); 506 507/* initialize struct pci20xxx_private */ 508static int pci20xxx_dio_init(struct comedi_device *dev, 509 struct comedi_subdevice *s) 510{ 511 512 s->type = COMEDI_SUBD_DIO; 513 s->subdev_flags = SDF_READABLE | SDF_WRITABLE; 514 s->n_chan = 32; 515 s->insn_bits = pci20xxx_dio_insn_bits; 516 s->insn_config = pci20xxx_dio_insn_config; 517 s->maxdata = 1; 518 s->len_chanlist = 32; 519 s->range_table = &range_digital; 520 s->io_bits = 0; 521 522 /* digital I/O lines default to input on board reset. */ 523 pci20xxx_dio_config(dev, s); 524 525 return 0; 526} 527 528static int pci20xxx_dio_insn_config(struct comedi_device *dev, 529 struct comedi_subdevice *s, 530 struct comedi_insn *insn, 531 unsigned int *data) 532{ 533 int mask, bits; 534 535 mask = 1 << CR_CHAN(insn->chanspec); 536 if (mask & 0x000000ff) 537 bits = 0x000000ff; 538 else if (mask & 0x0000ff00) 539 bits = 0x0000ff00; 540 else if (mask & 0x00ff0000) 541 bits = 0x00ff0000; 542 else 543 bits = 0xff000000; 544 if (data[0]) 545 s->io_bits |= bits; 546 else 547 s->io_bits &= ~bits; 548 pci20xxx_dio_config(dev, s); 549 550 return 1; 551} 552 553static int pci20xxx_dio_insn_bits(struct comedi_device *dev, 554 struct comedi_subdevice *s, 555 struct comedi_insn *insn, unsigned int *data) 556{ 557 unsigned int mask = data[0]; 558 559 s->state &= ~mask; 560 s->state |= (mask & data[1]); 561 562 mask &= s->io_bits; 563 if (mask & 0x000000ff) 564 writeb((s->state >> 0) & 0xff, 565 devpriv->ioaddr + PCI20000_DIO_0); 566 if (mask & 0x0000ff00) 567 writeb((s->state >> 8) & 0xff, 568 devpriv->ioaddr + PCI20000_DIO_1); 569 if (mask & 0x00ff0000) 570 writeb((s->state >> 16) & 0xff, 571 devpriv->ioaddr + PCI20000_DIO_2); 572 if (mask & 0xff000000) 573 writeb((s->state >> 24) & 0xff, 574 devpriv->ioaddr + PCI20000_DIO_3); 575 576 data[1] = readb(devpriv->ioaddr + PCI20000_DIO_0); 577 data[1] |= readb(devpriv->ioaddr + PCI20000_DIO_1) << 8; 578 data[1] |= readb(devpriv->ioaddr + PCI20000_DIO_2) << 16; 579 data[1] |= readb(devpriv->ioaddr + PCI20000_DIO_3) << 24; 580 581 return 2; 582} 583 584static void pci20xxx_dio_config(struct comedi_device *dev, 585 struct comedi_subdevice *s) 586{ 587 unsigned char control_01; 588 unsigned char control_23; 589 unsigned char buffer; 590 591 control_01 = readb(devpriv->ioaddr + PCI20000_DIO_CONTROL_01); 592 control_23 = readb(devpriv->ioaddr + PCI20000_DIO_CONTROL_23); 593 buffer = readb(devpriv->ioaddr + PCI20000_DIO_BUFFER); 594 595 if (s->io_bits & 0x000000ff) { 596 /* output port 0 */ 597 control_01 &= PCI20000_DIO_EOC; 598 buffer = (buffer & (~(DIO_BE << DIO_PS_0))) | (DIO_BO << 599 DIO_PS_0); 600 } else { 601 /* input port 0 */ 602 control_01 = (control_01 & DIO_CAND) | PCI20000_DIO_EIC; 603 buffer = (buffer & (~(DIO_BI << DIO_PS_0))); 604 } 605 if (s->io_bits & 0x0000ff00) { 606 /* output port 1 */ 607 control_01 &= PCI20000_DIO_OOC; 608 buffer = (buffer & (~(DIO_BE << DIO_PS_1))) | (DIO_BO << 609 DIO_PS_1); 610 } else { 611 /* input port 1 */ 612 control_01 = (control_01 & DIO_CAND) | PCI20000_DIO_OIC; 613 buffer = (buffer & (~(DIO_BI << DIO_PS_1))); 614 } 615 if (s->io_bits & 0x00ff0000) { 616 /* output port 2 */ 617 control_23 &= PCI20000_DIO_EOC; 618 buffer = (buffer & (~(DIO_BE << DIO_PS_2))) | (DIO_BO << 619 DIO_PS_2); 620 } else { 621 /* input port 2 */ 622 control_23 = (control_23 & DIO_CAND) | PCI20000_DIO_EIC; 623 buffer = (buffer & (~(DIO_BI << DIO_PS_2))); 624 } 625 if (s->io_bits & 0xff000000) { 626 /* output port 3 */ 627 control_23 &= PCI20000_DIO_OOC; 628 buffer = (buffer & (~(DIO_BE << DIO_PS_3))) | (DIO_BO << 629 DIO_PS_3); 630 } else { 631 /* input port 3 */ 632 control_23 = (control_23 & DIO_CAND) | PCI20000_DIO_OIC; 633 buffer = (buffer & (~(DIO_BI << DIO_PS_3))); 634 } 635 writeb(control_01, devpriv->ioaddr + PCI20000_DIO_CONTROL_01); 636 writeb(control_23, devpriv->ioaddr + PCI20000_DIO_CONTROL_23); 637 writeb(buffer, devpriv->ioaddr + PCI20000_DIO_BUFFER); 638} 639 640#if 0 641static void pci20xxx_do(struct comedi_device *dev, struct comedi_subdevice *s) 642{ 643 /* XXX if the channel is configured for input, does this 644 do bad things? */ 645 /* XXX it would be a good idea to only update the registers 646 that _need_ to be updated. This requires changes to 647 comedi, however. */ 648 writeb((s->state >> 0) & 0xff, devpriv->ioaddr + PCI20000_DIO_0); 649 writeb((s->state >> 8) & 0xff, devpriv->ioaddr + PCI20000_DIO_1); 650 writeb((s->state >> 16) & 0xff, devpriv->ioaddr + PCI20000_DIO_2); 651 writeb((s->state >> 24) & 0xff, devpriv->ioaddr + PCI20000_DIO_3); 652} 653 654static unsigned int pci20xxx_di(struct comedi_device *dev, 655 struct comedi_subdevice *s) 656{ 657 /* XXX same note as above */ 658 unsigned int bits; 659 660 bits = readb(devpriv->ioaddr + PCI20000_DIO_0); 661 bits |= readb(devpriv->ioaddr + PCI20000_DIO_1) << 8; 662 bits |= readb(devpriv->ioaddr + PCI20000_DIO_2) << 16; 663 bits |= readb(devpriv->ioaddr + PCI20000_DIO_3) << 24; 664 665 return bits; 666} 667#endif 668 669static int __init driver_pci20xxx_init_module(void) 670{ 671 return comedi_driver_register(&driver_pci20xxx); 672} 673 674static void __exit driver_pci20xxx_cleanup_module(void) 675{ 676 comedi_driver_unregister(&driver_pci20xxx); 677} 678 679module_init(driver_pci20xxx_init_module); 680module_exit(driver_pci20xxx_cleanup_module); 681 682MODULE_AUTHOR("Comedi http://www.comedi.org"); 683MODULE_DESCRIPTION("Comedi low-level driver"); 684MODULE_LICENSE("GPL"); 685