ni_daq_700.c revision fc301101034c06bf56a7f71bf682c48909e401a4
1/* 2 * comedi/drivers/ni_daq_700.c 3 * Driver for DAQCard-700 DIO only 4 * copied from 8255 5 * 6 * COMEDI - Linux Control and Measurement Device Interface 7 * Copyright (C) 1998 David A. Schleef <ds@schleef.org> 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License as published by 11 * the Free Software Foundation; either version 2 of the License, or 12 * (at your option) any later version. 13 * 14 * This program is distributed in the hope that it will be useful, 15 * but WITHOUT ANY WARRANTY; without even the implied warranty of 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17 * GNU General Public License for more details. 18 * 19 * You should have received a copy of the GNU General Public License 20 * along with this program; if not, write to the Free Software 21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 22 * 23 */ 24 25/* 26Driver: ni_daq_700 27Description: National Instruments PCMCIA DAQCard-700 DIO only 28Author: Fred Brooks <nsaspook@nsaspook.com>, 29 based on ni_daq_dio24 by Daniel Vecino Castel <dvecino@able.es> 30Devices: [National Instruments] PCMCIA DAQ-Card-700 (ni_daq_700) 31Status: works 32Updated: Thu, 21 Feb 2008 12:07:20 +0000 33 34The daqcard-700 appears in Comedi as a single digital I/O subdevice with 3516 channels. The channel 0 corresponds to the daqcard-700's output 36port, bit 0; channel 8 corresponds to the input port, bit 0. 37 38Direction configuration: channels 0-7 output, 8-15 input (8225 device 39emu as port A output, port B input, port C N/A). 40 41IRQ is assigned but not used. 42*/ 43 44#include <linux/interrupt.h> 45#include <linux/slab.h> 46#include "../comedidev.h" 47 48#include <linux/ioport.h> 49 50#include <pcmcia/cs.h> 51#include <pcmcia/cistpl.h> 52#include <pcmcia/cisreg.h> 53#include <pcmcia/ds.h> 54 55static struct pcmcia_device *pcmcia_cur_dev = NULL; 56 57#define DIO700_SIZE 8 /* size of io region used by board */ 58 59static int dio700_attach(struct comedi_device *dev, 60 struct comedi_devconfig *it); 61static int dio700_detach(struct comedi_device *dev); 62 63enum dio700_bustype { pcmcia_bustype }; 64 65struct dio700_board { 66 const char *name; 67 int device_id; /* device id for pcmcia board */ 68 enum dio700_bustype bustype; /* PCMCIA */ 69 int have_dio; /* have daqcard-700 dio */ 70 /* function pointers so we can use inb/outb or readb/writeb */ 71 /* as appropriate */ 72 unsigned int (*read_byte) (unsigned int address); 73 void (*write_byte) (unsigned int byte, unsigned int address); 74}; 75 76static const struct dio700_board dio700_boards[] = { 77 { 78 .name = "daqcard-700", 79 /* 0x10b is manufacturer id, 0x4743 is device id */ 80 .device_id = 0x4743, 81 .bustype = pcmcia_bustype, 82 .have_dio = 1, 83 }, 84 { 85 .name = "ni_daq_700", 86 /* 0x10b is manufacturer id, 0x4743 is device id */ 87 .device_id = 0x4743, 88 .bustype = pcmcia_bustype, 89 .have_dio = 1, 90 }, 91}; 92 93/* 94 * Useful for shorthand access to the particular board structure 95 */ 96#define thisboard ((const struct dio700_board *)dev->board_ptr) 97 98struct dio700_private { 99 100 int data; /* number of data points left to be taken */ 101}; 102 103#define devpriv ((struct dio700_private *)dev->private) 104 105static struct comedi_driver driver_dio700 = { 106 .driver_name = "ni_daq_700", 107 .module = THIS_MODULE, 108 .attach = dio700_attach, 109 .detach = dio700_detach, 110 .num_names = ARRAY_SIZE(dio700_boards), 111 .board_name = &dio700_boards[0].name, 112 .offset = sizeof(struct dio700_board), 113}; 114 115/* the real driver routines */ 116 117#define _700_SIZE 8 118 119#define _700_DATA 0 120 121#define DIO_W 0x04 122#define DIO_R 0x05 123 124struct subdev_700_struct { 125 unsigned long cb_arg; 126 int (*cb_func) (int, int, int, unsigned long); 127 int have_irq; 128}; 129 130#define CALLBACK_ARG (((struct subdev_700_struct *)s->private)->cb_arg) 131#define CALLBACK_FUNC (((struct subdev_700_struct *)s->private)->cb_func) 132#define subdevpriv ((struct subdev_700_struct *)s->private) 133 134static void do_config(struct comedi_device *dev, struct comedi_subdevice *s); 135 136void subdev_700_interrupt(struct comedi_device *dev, struct comedi_subdevice *s) 137{ 138 short d; 139 140 d = CALLBACK_FUNC(0, _700_DATA, 0, CALLBACK_ARG); 141 142 comedi_buf_put(s->async, d); 143 s->async->events |= COMEDI_CB_EOS; 144 145 comedi_event(dev, s); 146} 147EXPORT_SYMBOL(subdev_700_interrupt); 148 149static int subdev_700_cb(int dir, int port, int data, unsigned long arg) 150{ 151 /* port is always A for output and B for input (8255 emu) */ 152 unsigned long iobase = arg; 153 154 if (dir) { 155 outb(data, iobase + DIO_W); 156 return 0; 157 } else { 158 return inb(iobase + DIO_R); 159 } 160} 161 162static int subdev_700_insn(struct comedi_device *dev, 163 struct comedi_subdevice *s, struct comedi_insn *insn, 164 unsigned int *data) 165{ 166 if (data[0]) { 167 s->state &= ~data[0]; 168 s->state |= (data[0] & data[1]); 169 170 if (data[0] & 0xff) 171 CALLBACK_FUNC(1, _700_DATA, s->state & 0xff, 172 CALLBACK_ARG); 173 } 174 175 data[1] = s->state & 0xff; 176 data[1] |= CALLBACK_FUNC(0, _700_DATA, 0, CALLBACK_ARG) << 8; 177 178 return 2; 179} 180 181static int subdev_700_insn_config(struct comedi_device *dev, 182 struct comedi_subdevice *s, 183 struct comedi_insn *insn, unsigned int *data) 184{ 185 186 switch (data[0]) { 187 case INSN_CONFIG_DIO_INPUT: 188 break; 189 case INSN_CONFIG_DIO_OUTPUT: 190 break; 191 case INSN_CONFIG_DIO_QUERY: 192 data[1] = 193 (s-> 194 io_bits & (1 << CR_CHAN(insn->chanspec))) ? COMEDI_OUTPUT : 195 COMEDI_INPUT; 196 return insn->n; 197 break; 198 default: 199 return -EINVAL; 200 } 201 202 return 1; 203} 204 205static void do_config(struct comedi_device *dev, struct comedi_subdevice *s) 206{ /* use powerup defaults */ 207 return; 208} 209 210static int subdev_700_cmdtest(struct comedi_device *dev, 211 struct comedi_subdevice *s, 212 struct comedi_cmd *cmd) 213{ 214 int err = 0; 215 unsigned int tmp; 216 217 /* step 1 */ 218 219 tmp = cmd->start_src; 220 cmd->start_src &= TRIG_NOW; 221 if (!cmd->start_src || tmp != cmd->start_src) 222 err++; 223 224 tmp = cmd->scan_begin_src; 225 cmd->scan_begin_src &= TRIG_EXT; 226 if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src) 227 err++; 228 229 tmp = cmd->convert_src; 230 cmd->convert_src &= TRIG_FOLLOW; 231 if (!cmd->convert_src || tmp != cmd->convert_src) 232 err++; 233 234 tmp = cmd->scan_end_src; 235 cmd->scan_end_src &= TRIG_COUNT; 236 if (!cmd->scan_end_src || tmp != cmd->scan_end_src) 237 err++; 238 239 tmp = cmd->stop_src; 240 cmd->stop_src &= TRIG_NONE; 241 if (!cmd->stop_src || tmp != cmd->stop_src) 242 err++; 243 244 if (err) 245 return 1; 246 247 /* step 2 */ 248 249 if (err) 250 return 2; 251 252 /* step 3 */ 253 254 if (cmd->start_arg != 0) { 255 cmd->start_arg = 0; 256 err++; 257 } 258 if (cmd->scan_begin_arg != 0) { 259 cmd->scan_begin_arg = 0; 260 err++; 261 } 262 if (cmd->convert_arg != 0) { 263 cmd->convert_arg = 0; 264 err++; 265 } 266 if (cmd->scan_end_arg != 1) { 267 cmd->scan_end_arg = 1; 268 err++; 269 } 270 if (cmd->stop_arg != 0) { 271 cmd->stop_arg = 0; 272 err++; 273 } 274 275 if (err) 276 return 3; 277 278 /* step 4 */ 279 280 if (err) 281 return 4; 282 283 return 0; 284} 285 286static int subdev_700_cmd(struct comedi_device *dev, struct comedi_subdevice *s) 287{ 288 /* FIXME */ 289 290 return 0; 291} 292 293static int subdev_700_cancel(struct comedi_device *dev, 294 struct comedi_subdevice *s) 295{ 296 /* FIXME */ 297 298 return 0; 299} 300 301int subdev_700_init(struct comedi_device *dev, struct comedi_subdevice *s, 302 int (*cb) (int, int, int, unsigned long), unsigned long arg) 303{ 304 s->type = COMEDI_SUBD_DIO; 305 s->subdev_flags = SDF_READABLE | SDF_WRITABLE; 306 s->n_chan = 16; 307 s->range_table = &range_digital; 308 s->maxdata = 1; 309 310 s->private = kmalloc(sizeof(struct subdev_700_struct), GFP_KERNEL); 311 if (!s->private) 312 return -ENOMEM; 313 314 CALLBACK_ARG = arg; 315 if (cb == NULL) 316 CALLBACK_FUNC = subdev_700_cb; 317 else 318 CALLBACK_FUNC = cb; 319 320 s->insn_bits = subdev_700_insn; 321 s->insn_config = subdev_700_insn_config; 322 323 s->state = 0; 324 s->io_bits = 0x00ff; 325 do_config(dev, s); 326 327 return 0; 328} 329EXPORT_SYMBOL(subdev_700_init); 330 331int subdev_700_init_irq(struct comedi_device *dev, struct comedi_subdevice *s, 332 int (*cb) (int, int, int, unsigned long), 333 unsigned long arg) 334{ 335 int ret; 336 337 ret = subdev_700_init(dev, s, cb, arg); 338 if (ret < 0) 339 return ret; 340 341 s->do_cmdtest = subdev_700_cmdtest; 342 s->do_cmd = subdev_700_cmd; 343 s->cancel = subdev_700_cancel; 344 345 subdevpriv->have_irq = 1; 346 347 return 0; 348} 349EXPORT_SYMBOL(subdev_700_init_irq); 350 351void subdev_700_cleanup(struct comedi_device *dev, struct comedi_subdevice *s) 352{ 353 if (s->private) 354 if (subdevpriv->have_irq) 355 356 kfree(s->private); 357} 358EXPORT_SYMBOL(subdev_700_cleanup); 359 360static int dio700_attach(struct comedi_device *dev, struct comedi_devconfig *it) 361{ 362 struct comedi_subdevice *s; 363 unsigned long iobase = 0; 364#ifdef incomplete 365 unsigned int irq = 0; 366#endif 367 struct pcmcia_device *link; 368 369 /* allocate and initialize dev->private */ 370 if (alloc_private(dev, sizeof(struct dio700_private)) < 0) 371 return -ENOMEM; 372 373 /* get base address, irq etc. based on bustype */ 374 switch (thisboard->bustype) { 375 case pcmcia_bustype: 376 link = pcmcia_cur_dev; /* XXX hack */ 377 if (!link) 378 return -EIO; 379 iobase = link->resource[0]->start; 380#ifdef incomplete 381 irq = link->irq; 382#endif 383 break; 384 default: 385 printk("bug! couldn't determine board type\n"); 386 return -EINVAL; 387 break; 388 } 389 printk("comedi%d: ni_daq_700: %s, io 0x%lx", dev->minor, 390 thisboard->name, iobase); 391#ifdef incomplete 392 if (irq) 393 printk(", irq %u", irq); 394 395#endif 396 397 printk("\n"); 398 399 if (iobase == 0) { 400 printk("io base address is zero!\n"); 401 return -EINVAL; 402 } 403 404 dev->iobase = iobase; 405 406#ifdef incomplete 407 /* grab our IRQ */ 408 dev->irq = irq; 409#endif 410 411 dev->board_name = thisboard->name; 412 413 if (alloc_subdevices(dev, 1) < 0) 414 return -ENOMEM; 415 416 /* DAQCard-700 dio */ 417 s = dev->subdevices + 0; 418 subdev_700_init(dev, s, NULL, dev->iobase); 419 420 return 0; 421}; 422 423static int dio700_detach(struct comedi_device *dev) 424{ 425 printk("comedi%d: ni_daq_700: cs-remove\n", dev->minor); 426 427 if (dev->subdevices) 428 subdev_700_cleanup(dev, dev->subdevices + 0); 429 430 if (thisboard->bustype != pcmcia_bustype && dev->iobase) 431 release_region(dev->iobase, DIO700_SIZE); 432 if (dev->irq) 433 free_irq(dev->irq, dev); 434 435 return 0; 436}; 437 438/* PCMCIA crap -- watch your words, please! */ 439 440static void dio700_config(struct pcmcia_device *link); 441static void dio700_release(struct pcmcia_device *link); 442static int dio700_cs_suspend(struct pcmcia_device *p_dev); 443static int dio700_cs_resume(struct pcmcia_device *p_dev); 444 445/* 446 The attach() and detach() entry points are used to create and destroy 447 "instances" of the driver, where each instance represents everything 448 needed to manage one actual PCMCIA card. 449*/ 450 451static int dio700_cs_attach(struct pcmcia_device *); 452static void dio700_cs_detach(struct pcmcia_device *); 453 454/* 455 You'll also need to prototype all the functions that will actually 456 be used to talk to your device. See 'memory_cs' for a good example 457 of a fully self-sufficient driver; the other drivers rely more or 458 less on other parts of the kernel. 459*/ 460 461struct local_info_t { 462 struct pcmcia_device *link; 463 int stop; 464 struct bus_operations *bus; 465}; 466 467/*====================================================================== 468 469 dio700_cs_attach() creates an "instance" of the driver, allocating 470 local data structures for one device. The device is registered 471 with Card Services. 472 473 The dev_link structure is initialized, but we don't actually 474 configure the card at this point -- we wait until we receive a 475 card insertion event. 476 477======================================================================*/ 478 479static int dio700_cs_attach(struct pcmcia_device *link) 480{ 481 struct local_info_t *local; 482 483 printk(KERN_INFO "ni_daq_700: cs-attach\n"); 484 485 dev_dbg(&link->dev, "dio700_cs_attach()\n"); 486 487 /* Allocate space for private device-specific data */ 488 local = kzalloc(sizeof(struct local_info_t), GFP_KERNEL); 489 if (!local) 490 return -ENOMEM; 491 local->link = link; 492 link->priv = local; 493 494 /* 495 General socket configuration defaults can go here. In this 496 client, we assume very little, and rely on the CIS for almost 497 everything. In most clients, many details (i.e., number, sizes, 498 and attributes of IO windows) are fixed by the nature of the 499 device, and can be hard-wired here. 500 */ 501 link->conf.Attributes = 0; 502 link->conf.IntType = INT_MEMORY_AND_IO; 503 504 pcmcia_cur_dev = link; 505 506 dio700_config(link); 507 508 return 0; 509} /* dio700_cs_attach */ 510 511/*====================================================================== 512 513 This deletes a driver "instance". The device is de-registered 514 with Card Services. If it has been released, all local data 515 structures are freed. Otherwise, the structures will be freed 516 when the device is released. 517 518======================================================================*/ 519 520static void dio700_cs_detach(struct pcmcia_device *link) 521{ 522 523 printk(KERN_INFO "ni_daq_700: cs-detach!\n"); 524 525 dev_dbg(&link->dev, "dio700_cs_detach\n"); 526 527 ((struct local_info_t *)link->priv)->stop = 1; 528 dio700_release(link); 529 530 /* This points to the parent struct local_info_t struct */ 531 kfree(link->priv); 532 533} /* dio700_cs_detach */ 534 535/*====================================================================== 536 537 dio700_config() is scheduled to run after a CARD_INSERTION event 538 is received, to configure the PCMCIA socket, and to make the 539 device available to the system. 540 541======================================================================*/ 542 543static int dio700_pcmcia_config_loop(struct pcmcia_device *p_dev, 544 cistpl_cftable_entry_t *cfg, 545 cistpl_cftable_entry_t *dflt, 546 unsigned int vcc, 547 void *priv_data) 548{ 549 if (cfg->index == 0) 550 return -ENODEV; 551 552 /* Does this card need audio output? */ 553 if (cfg->flags & CISTPL_CFTABLE_AUDIO) 554 p_dev->conf.Attributes |= CONF_ENABLE_SPKR; 555 556 /* Do we need to allocate an interrupt? */ 557 p_dev->conf.Attributes |= CONF_ENABLE_IRQ; 558 559 /* IO window settings */ 560 p_dev->resource[0]->end = p_dev->resource[1]->end = 0; 561 if ((cfg->io.nwin > 0) || (dflt->io.nwin > 0)) { 562 cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt->io; 563 p_dev->io_lines = io->flags & CISTPL_IO_LINES_MASK; 564 p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH; 565 p_dev->resource[0]->flags |= 566 pcmcia_io_cfg_data_width(io->flags); 567 p_dev->resource[0]->start = io->win[0].base; 568 p_dev->resource[0]->end = io->win[0].len; 569 if (io->nwin > 1) { 570 p_dev->resource[1]->flags = p_dev->resource[0]->flags; 571 p_dev->resource[1]->start = io->win[1].base; 572 p_dev->resource[1]->end = io->win[1].len; 573 } 574 /* This reserves IO space but doesn't actually enable it */ 575 if (pcmcia_request_io(p_dev) != 0) 576 return -ENODEV; 577 } 578 579 /* If we got this far, we're cool! */ 580 return 0; 581} 582 583static void dio700_config(struct pcmcia_device *link) 584{ 585 win_req_t req; 586 int ret; 587 588 printk(KERN_INFO "ni_daq_700: cs-config\n"); 589 590 dev_dbg(&link->dev, "dio700_config\n"); 591 592 ret = pcmcia_loop_config(link, dio700_pcmcia_config_loop, NULL); 593 if (ret) { 594 dev_warn(&link->dev, "no configuration found\n"); 595 goto failed; 596 } 597 598 if (!link->irq) 599 goto failed; 600 601 /* 602 This actually configures the PCMCIA socket -- setting up 603 the I/O windows and the interrupt mapping, and putting the 604 card and host interface into "Memory and IO" mode. 605 */ 606 ret = pcmcia_request_configuration(link, &link->conf); 607 if (ret != 0) 608 goto failed; 609 610 /* Finally, report what we've done */ 611 dev_info(&link->dev, "index 0x%02x", link->conf.ConfigIndex); 612 if (link->conf.Attributes & CONF_ENABLE_IRQ) 613 printk(", irq %d", link->irq); 614 if (link->resource[0]) 615 printk(", io %pR", link->resource[0]); 616 if (link->resource[1]) 617 printk(" & %pR", link->resource[1]); 618 printk("\n"); 619 620 return; 621 622failed: 623 printk(KERN_INFO "ni_daq_700 cs failed"); 624 dio700_release(link); 625 626} /* dio700_config */ 627 628static void dio700_release(struct pcmcia_device *link) 629{ 630 dev_dbg(&link->dev, "dio700_release\n"); 631 632 pcmcia_disable_device(link); 633} /* dio700_release */ 634 635/*====================================================================== 636 637 The card status event handler. Mostly, this schedules other 638 stuff to run after an event is received. 639 640 When a CARD_REMOVAL event is received, we immediately set a 641 private flag to block future accesses to this device. All the 642 functions that actually access the device should check this flag 643 to make sure the card is still present. 644 645======================================================================*/ 646 647static int dio700_cs_suspend(struct pcmcia_device *link) 648{ 649 struct local_info_t *local = link->priv; 650 651 /* Mark the device as stopped, to block IO until later */ 652 local->stop = 1; 653 return 0; 654} /* dio700_cs_suspend */ 655 656static int dio700_cs_resume(struct pcmcia_device *link) 657{ 658 struct local_info_t *local = link->priv; 659 660 local->stop = 0; 661 return 0; 662} /* dio700_cs_resume */ 663 664/*====================================================================*/ 665 666static struct pcmcia_device_id dio700_cs_ids[] = { 667 /* N.B. These IDs should match those in dio700_boards */ 668 PCMCIA_DEVICE_MANF_CARD(0x010b, 0x4743), /* daqcard-700 */ 669 PCMCIA_DEVICE_NULL 670}; 671 672 673MODULE_DEVICE_TABLE(pcmcia, dio700_cs_ids); 674MODULE_AUTHOR("Fred Brooks <nsaspook@nsaspook.com>"); 675MODULE_DESCRIPTION("Comedi driver for National Instruments " 676 "PCMCIA DAQCard-700 DIO"); 677MODULE_LICENSE("GPL"); 678 679struct pcmcia_driver dio700_cs_driver = { 680 .probe = dio700_cs_attach, 681 .remove = dio700_cs_detach, 682 .suspend = dio700_cs_suspend, 683 .resume = dio700_cs_resume, 684 .id_table = dio700_cs_ids, 685 .owner = THIS_MODULE, 686 .drv = { 687 .name = "ni_daq_700", 688 }, 689}; 690 691static int __init init_dio700_cs(void) 692{ 693 pcmcia_register_driver(&dio700_cs_driver); 694 return 0; 695} 696 697static void __exit exit_dio700_cs(void) 698{ 699 pr_debug("ni_daq_700: unloading\n"); 700 pcmcia_unregister_driver(&dio700_cs_driver); 701} 702 703int __init init_module(void) 704{ 705 int ret; 706 707 ret = init_dio700_cs(); 708 if (ret < 0) 709 return ret; 710 711 return comedi_driver_register(&driver_dio700); 712} 713 714void __exit cleanup_module(void) 715{ 716 exit_dio700_cs(); 717 comedi_driver_unregister(&driver_dio700); 718} 719