ni_daq_700.c revision b5cb259e7fac5536c4ddf350af6a3d6cc950e47e
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 461/* 462 The dev_info variable is the "key" that is used to match up this 463 device driver with appropriate cards, through the card configuration 464 database. 465*/ 466 467static const dev_info_t dev_info = "ni_daq_700"; 468 469struct local_info_t { 470 struct pcmcia_device *link; 471 int stop; 472 struct bus_operations *bus; 473}; 474 475/*====================================================================== 476 477 dio700_cs_attach() creates an "instance" of the driver, allocating 478 local data structures for one device. The device is registered 479 with Card Services. 480 481 The dev_link structure is initialized, but we don't actually 482 configure the card at this point -- we wait until we receive a 483 card insertion event. 484 485======================================================================*/ 486 487static int dio700_cs_attach(struct pcmcia_device *link) 488{ 489 struct local_info_t *local; 490 491 printk(KERN_INFO "ni_daq_700: cs-attach\n"); 492 493 dev_dbg(&link->dev, "dio700_cs_attach()\n"); 494 495 /* Allocate space for private device-specific data */ 496 local = kzalloc(sizeof(struct local_info_t), GFP_KERNEL); 497 if (!local) 498 return -ENOMEM; 499 local->link = link; 500 link->priv = local; 501 502 /* 503 General socket configuration defaults can go here. In this 504 client, we assume very little, and rely on the CIS for almost 505 everything. In most clients, many details (i.e., number, sizes, 506 and attributes of IO windows) are fixed by the nature of the 507 device, and can be hard-wired here. 508 */ 509 link->conf.Attributes = 0; 510 link->conf.IntType = INT_MEMORY_AND_IO; 511 512 pcmcia_cur_dev = link; 513 514 dio700_config(link); 515 516 return 0; 517} /* dio700_cs_attach */ 518 519/*====================================================================== 520 521 This deletes a driver "instance". The device is de-registered 522 with Card Services. If it has been released, all local data 523 structures are freed. Otherwise, the structures will be freed 524 when the device is released. 525 526======================================================================*/ 527 528static void dio700_cs_detach(struct pcmcia_device *link) 529{ 530 531 printk(KERN_INFO "ni_daq_700: cs-detach!\n"); 532 533 dev_dbg(&link->dev, "dio700_cs_detach\n"); 534 535 ((struct local_info_t *)link->priv)->stop = 1; 536 dio700_release(link); 537 538 /* This points to the parent struct local_info_t struct */ 539 if (link->priv) 540 kfree(link->priv); 541 542} /* dio700_cs_detach */ 543 544/*====================================================================== 545 546 dio700_config() is scheduled to run after a CARD_INSERTION event 547 is received, to configure the PCMCIA socket, and to make the 548 device available to the system. 549 550======================================================================*/ 551 552static int dio700_pcmcia_config_loop(struct pcmcia_device *p_dev, 553 cistpl_cftable_entry_t *cfg, 554 cistpl_cftable_entry_t *dflt, 555 unsigned int vcc, 556 void *priv_data) 557{ 558 win_req_t *req = priv_data; 559 560 if (cfg->index == 0) 561 return -ENODEV; 562 563 /* Does this card need audio output? */ 564 if (cfg->flags & CISTPL_CFTABLE_AUDIO) { 565 p_dev->conf.Attributes |= CONF_ENABLE_SPKR; 566 p_dev->conf.Status = CCSR_AUDIO_ENA; 567 } 568 569 /* Do we need to allocate an interrupt? */ 570 p_dev->conf.Attributes |= CONF_ENABLE_IRQ; 571 572 /* IO window settings */ 573 p_dev->resource[0]->end = p_dev->resource[1]->end = 0; 574 if ((cfg->io.nwin > 0) || (dflt->io.nwin > 0)) { 575 cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt->io; 576 p_dev->io_lines = io->flags & CISTPL_IO_LINES_MASK; 577 p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH; 578 p_dev->resource[0]->flags |= 579 pcmcia_io_cfg_data_width(io->flags); 580 p_dev->resource[0]->start = io->win[0].base; 581 p_dev->resource[0]->end = io->win[0].len; 582 if (io->nwin > 1) { 583 p_dev->resource[1]->flags = p_dev->resource[0]->flags; 584 p_dev->resource[1]->start = io->win[1].base; 585 p_dev->resource[1]->end = io->win[1].len; 586 } 587 /* This reserves IO space but doesn't actually enable it */ 588 if (pcmcia_request_io(p_dev) != 0) 589 return -ENODEV; 590 } 591 592 if ((cfg->mem.nwin > 0) || (dflt->mem.nwin > 0)) { 593 cistpl_mem_t *mem = 594 (cfg->mem.nwin) ? &cfg->mem : &dflt->mem; 595 req->Attributes = WIN_DATA_WIDTH_16 | WIN_MEMORY_TYPE_CM; 596 req->Attributes |= WIN_ENABLE; 597 req->Base = mem->win[0].host_addr; 598 req->Size = mem->win[0].len; 599 if (req->Size < 0x1000) 600 req->Size = 0x1000; 601 req->AccessSpeed = 0; 602 if (pcmcia_request_window(p_dev, req, &p_dev->win)) 603 return -ENODEV; 604 if (pcmcia_map_mem_page(p_dev, p_dev->win, 605 mem->win[0].card_addr)) 606 return -ENODEV; 607 } 608 /* If we got this far, we're cool! */ 609 return 0; 610} 611 612static void dio700_config(struct pcmcia_device *link) 613{ 614 win_req_t req; 615 int ret; 616 617 printk(KERN_INFO "ni_daq_700: cs-config\n"); 618 619 dev_dbg(&link->dev, "dio700_config\n"); 620 621 ret = pcmcia_loop_config(link, dio700_pcmcia_config_loop, &req); 622 if (ret) { 623 dev_warn(&link->dev, "no configuration found\n"); 624 goto failed; 625 } 626 627 if (!link->irq) 628 goto failed; 629 630 /* 631 This actually configures the PCMCIA socket -- setting up 632 the I/O windows and the interrupt mapping, and putting the 633 card and host interface into "Memory and IO" mode. 634 */ 635 ret = pcmcia_request_configuration(link, &link->conf); 636 if (ret != 0) 637 goto failed; 638 639 /* Finally, report what we've done */ 640 dev_info(&link->dev, "index 0x%02x", link->conf.ConfigIndex); 641 if (link->conf.Attributes & CONF_ENABLE_IRQ) 642 printk(", irq %d", link->irq); 643 if (link->resource[0]) 644 printk(", io %pR", link->resource[0]); 645 if (link->resource[1]) 646 printk(" & %pR", link->resource[1]); 647 if (link->win) 648 printk(", mem 0x%06lx-0x%06lx", req.Base, 649 req.Base + req.Size - 1); 650 printk("\n"); 651 652 return; 653 654failed: 655 printk(KERN_INFO "ni_daq_700 cs failed"); 656 dio700_release(link); 657 658} /* dio700_config */ 659 660static void dio700_release(struct pcmcia_device *link) 661{ 662 dev_dbg(&link->dev, "dio700_release\n"); 663 664 pcmcia_disable_device(link); 665} /* dio700_release */ 666 667/*====================================================================== 668 669 The card status event handler. Mostly, this schedules other 670 stuff to run after an event is received. 671 672 When a CARD_REMOVAL event is received, we immediately set a 673 private flag to block future accesses to this device. All the 674 functions that actually access the device should check this flag 675 to make sure the card is still present. 676 677======================================================================*/ 678 679static int dio700_cs_suspend(struct pcmcia_device *link) 680{ 681 struct local_info_t *local = link->priv; 682 683 /* Mark the device as stopped, to block IO until later */ 684 local->stop = 1; 685 return 0; 686} /* dio700_cs_suspend */ 687 688static int dio700_cs_resume(struct pcmcia_device *link) 689{ 690 struct local_info_t *local = link->priv; 691 692 local->stop = 0; 693 return 0; 694} /* dio700_cs_resume */ 695 696/*====================================================================*/ 697 698static struct pcmcia_device_id dio700_cs_ids[] = { 699 /* N.B. These IDs should match those in dio700_boards */ 700 PCMCIA_DEVICE_MANF_CARD(0x010b, 0x4743), /* daqcard-700 */ 701 PCMCIA_DEVICE_NULL 702}; 703 704 705MODULE_DEVICE_TABLE(pcmcia, dio700_cs_ids); 706MODULE_AUTHOR("Fred Brooks <nsaspook@nsaspook.com>"); 707MODULE_DESCRIPTION("Comedi driver for National Instruments " 708 "PCMCIA DAQCard-700 DIO"); 709MODULE_LICENSE("GPL"); 710 711struct pcmcia_driver dio700_cs_driver = { 712 .probe = dio700_cs_attach, 713 .remove = dio700_cs_detach, 714 .suspend = dio700_cs_suspend, 715 .resume = dio700_cs_resume, 716 .id_table = dio700_cs_ids, 717 .owner = THIS_MODULE, 718 .drv = { 719 .name = dev_info, 720 }, 721}; 722 723static int __init init_dio700_cs(void) 724{ 725 pcmcia_register_driver(&dio700_cs_driver); 726 return 0; 727} 728 729static void __exit exit_dio700_cs(void) 730{ 731 pr_debug("ni_daq_700: unloading\n"); 732 pcmcia_unregister_driver(&dio700_cs_driver); 733} 734 735int __init init_module(void) 736{ 737 int ret; 738 739 ret = init_dio700_cs(); 740 if (ret < 0) 741 return ret; 742 743 return comedi_driver_register(&driver_dio700); 744} 745 746void __exit cleanup_module(void) 747{ 748 exit_dio700_cs(); 749 comedi_driver_unregister(&driver_dio700); 750} 751