me_daq.c revision 727b286b44ea359d66f47d241cc2cdad36ed7bdc
1/* 2 3 comedi/drivers/me_daq.c 4 5 Hardware driver for Meilhaus data acquisition cards: 6 7 ME-2000i, ME-2600i, ME-3000vm1 8 9 Copyright (C) 2002 Michael Hillmann <hillmann@syscongroup.de> 10 11 This program is free software; you can redistribute it and/or modify 12 it under the terms of the GNU General Public License as published by 13 the Free Software Foundation; either version 2 of the License, or 14 (at your option) any later version. 15 16 This program is distributed in the hope that it will be useful, 17 but WITHOUT ANY WARRANTY; without even the implied warranty of 18 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 19 GNU General Public License for more details. 20 21 You should have received a copy of the GNU General Public License 22 along with this program; if not, write to the Free Software 23 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 24*/ 25 26/* 27Driver: me_daq 28Description: Meilhaus PCI data acquisition cards 29Author: Michael Hillmann <hillmann@syscongroup.de> 30Devices: [Meilhaus] ME-2600i (me_daq), ME-2000i 31Status: experimental 32 33Supports: 34 35 Analog Output 36 37Configuration options: 38 39 [0] - PCI bus number (optional) 40 [1] - PCI slot number (optional) 41 42 If bus/slot is not specified, the first available PCI 43 device will be used. 44 45The 2600 requires a firmware upload, which can be accomplished 46using the -i or --init-data option of comedi_config. 47The firmware can be 48found in the comedi_nonfree_firmware tarball available 49from http://www.comedi.org 50 51*/ 52 53#include <linux/interrupt.h> 54#include <linux/sched.h> 55#include "../comedidev.h" 56 57#include "comedi_pci.h" 58 59/*#include "me2600_fw.h" */ 60 61#define ME_DRIVER_NAME "me_daq" 62 63#define PCI_VENDOR_ID_MEILHAUS 0x1402 64#define ME2000_DEVICE_ID 0x2000 65#define ME2600_DEVICE_ID 0x2600 66 67#define PLX_INTCSR 0x4C /* PLX interrupt status register */ 68#define XILINX_DOWNLOAD_RESET 0x42 /* Xilinx registers */ 69 70#define ME_CONTROL_1 0x0000 /* - | W */ 71#define INTERRUPT_ENABLE (1<<15) 72#define COUNTER_B_IRQ (1<<12) 73#define COUNTER_A_IRQ (1<<11) 74#define CHANLIST_READY_IRQ (1<<10) 75#define EXT_IRQ (1<<9) 76#define ADFIFO_HALFFULL_IRQ (1<<8) 77#define SCAN_COUNT_ENABLE (1<<5) 78#define SIMULTANEOUS_ENABLE (1<<4) 79#define TRIGGER_FALLING_EDGE (1<<3) 80#define CONTINUOUS_MODE (1<<2) 81#define DISABLE_ADC (0<<0) 82#define SOFTWARE_TRIGGERED_ADC (1<<0) 83#define SCAN_TRIGGERED_ADC (2<<0) 84#define EXT_TRIGGERED_ADC (3<<0) 85#define ME_ADC_START 0x0000 /* R | - */ 86#define ME_CONTROL_2 0x0002 /* - | W */ 87#define ENABLE_ADFIFO (1<<10) 88#define ENABLE_CHANLIST (1<<9) 89#define ENABLE_PORT_B (1<<7) 90#define ENABLE_PORT_A (1<<6) 91#define ENABLE_COUNTER_B (1<<4) 92#define ENABLE_COUNTER_A (1<<3) 93#define ENABLE_DAC (1<<1) 94#define BUFFERED_DAC (1<<0) 95#define ME_DAC_UPDATE 0x0002 /* R | - */ 96#define ME_STATUS 0x0004 /* R | - */ 97#define COUNTER_B_IRQ_PENDING (1<<12) 98#define COUNTER_A_IRQ_PENDING (1<<11) 99#define CHANLIST_READY_IRQ_PENDING (1<<10) 100#define EXT_IRQ_PENDING (1<<9) 101#define ADFIFO_HALFFULL_IRQ_PENDING (1<<8) 102#define ADFIFO_FULL (1<<4) 103#define ADFIFO_HALFFULL (1<<3) 104#define ADFIFO_EMPTY (1<<2) 105#define CHANLIST_FULL (1<<1) 106#define FST_ACTIVE (1<<0) 107#define ME_RESET_INTERRUPT 0x0004 /* - | W */ 108#define ME_DIO_PORT_A 0x0006 /* R | W */ 109#define ME_DIO_PORT_B 0x0008 /* R | W */ 110#define ME_TIMER_DATA_0 0x000A /* - | W */ 111#define ME_TIMER_DATA_1 0x000C /* - | W */ 112#define ME_TIMER_DATA_2 0x000E /* - | W */ 113#define ME_CHANNEL_LIST 0x0010 /* - | W */ 114#define ADC_UNIPOLAR (1<<6) 115#define ADC_GAIN_0 (0<<4) 116#define ADC_GAIN_1 (1<<4) 117#define ADC_GAIN_2 (2<<4) 118#define ADC_GAIN_3 (3<<4) 119#define ME_READ_AD_FIFO 0x0010 /* R | - */ 120#define ME_DAC_CONTROL 0x0012 /* - | W */ 121#define DAC_UNIPOLAR_D (0<<4) 122#define DAC_BIPOLAR_D (1<<4) 123#define DAC_UNIPOLAR_C (0<<5) 124#define DAC_BIPOLAR_C (1<<5) 125#define DAC_UNIPOLAR_B (0<<6) 126#define DAC_BIPOLAR_B (1<<6) 127#define DAC_UNIPOLAR_A (0<<7) 128#define DAC_BIPOLAR_A (1<<7) 129#define DAC_GAIN_0_D (0<<8) 130#define DAC_GAIN_1_D (1<<8) 131#define DAC_GAIN_0_C (0<<9) 132#define DAC_GAIN_1_C (1<<9) 133#define DAC_GAIN_0_B (0<<10) 134#define DAC_GAIN_1_B (1<<10) 135#define DAC_GAIN_0_A (0<<11) 136#define DAC_GAIN_1_A (1<<11) 137#define ME_DAC_CONTROL_UPDATE 0x0012 /* R | - */ 138#define ME_DAC_DATA_A 0x0014 /* - | W */ 139#define ME_DAC_DATA_B 0x0016 /* - | W */ 140#define ME_DAC_DATA_C 0x0018 /* - | W */ 141#define ME_DAC_DATA_D 0x001A /* - | W */ 142#define ME_COUNTER_ENDDATA_A 0x001C /* - | W */ 143#define ME_COUNTER_ENDDATA_B 0x001E /* - | W */ 144#define ME_COUNTER_STARTDATA_A 0x0020 /* - | W */ 145#define ME_COUNTER_VALUE_A 0x0020 /* R | - */ 146#define ME_COUNTER_STARTDATA_B 0x0022 /* - | W */ 147#define ME_COUNTER_VALUE_B 0x0022 /* R | - */ 148 149/* Function prototypes */ 150static int me_attach(struct comedi_device *dev, struct comedi_devconfig *it); 151static int me_detach(struct comedi_device *dev); 152 153static const struct comedi_lrange me2000_ai_range = { 154 8, 155 { 156 BIP_RANGE(10), 157 BIP_RANGE(5), 158 BIP_RANGE(2.5), 159 BIP_RANGE(1.25), 160 UNI_RANGE(10), 161 UNI_RANGE(5), 162 UNI_RANGE(2.5), 163 UNI_RANGE(1.25) 164 } 165}; 166 167static const struct comedi_lrange me2600_ai_range = { 168 8, 169 { 170 BIP_RANGE(10), 171 BIP_RANGE(5), 172 BIP_RANGE(2.5), 173 BIP_RANGE(1.25), 174 UNI_RANGE(10), 175 UNI_RANGE(5), 176 UNI_RANGE(2.5), 177 UNI_RANGE(1.25) 178 } 179}; 180 181static const struct comedi_lrange me2600_ao_range = { 182 3, 183 { 184 BIP_RANGE(10), 185 BIP_RANGE(5), 186 UNI_RANGE(10) 187 } 188}; 189 190static DEFINE_PCI_DEVICE_TABLE(me_pci_table) = { 191 { 192 PCI_VENDOR_ID_MEILHAUS, ME2600_DEVICE_ID, PCI_ANY_ID, 193 PCI_ANY_ID, 0, 0, 0}, { 194 PCI_VENDOR_ID_MEILHAUS, ME2000_DEVICE_ID, PCI_ANY_ID, 195 PCI_ANY_ID, 0, 0, 0}, { 196 0} 197}; 198 199MODULE_DEVICE_TABLE(pci, me_pci_table); 200 201/* Board specification structure */ 202struct me_board { 203 const char *name; /* driver name */ 204 int device_id; 205 int ao_channel_nbr; /* DA config */ 206 int ao_resolution; 207 int ao_resolution_mask; 208 const struct comedi_lrange *ao_range_list; 209 int ai_channel_nbr; /* AD config */ 210 int ai_resolution; 211 int ai_resolution_mask; 212 const struct comedi_lrange *ai_range_list; 213 int dio_channel_nbr; /* DIO config */ 214}; 215 216static const struct me_board me_boards[] = { 217 { 218 /* -- ME-2600i -- */ 219 .name = ME_DRIVER_NAME, 220 .device_id = ME2600_DEVICE_ID, 221 /* Analog Output */ 222 .ao_channel_nbr = 4, 223 .ao_resolution = 12, 224 .ao_resolution_mask = 0x0fff, 225 .ao_range_list = &me2600_ao_range, 226 .ai_channel_nbr = 16, 227 /* Analog Input */ 228 .ai_resolution = 12, 229 .ai_resolution_mask = 0x0fff, 230 .ai_range_list = &me2600_ai_range, 231 .dio_channel_nbr = 32, 232 }, 233 { 234 /* -- ME-2000i -- */ 235 .name = ME_DRIVER_NAME, 236 .device_id = ME2000_DEVICE_ID, 237 /* Analog Output */ 238 .ao_channel_nbr = 0, 239 .ao_resolution = 0, 240 .ao_resolution_mask = 0, 241 .ao_range_list = NULL, 242 .ai_channel_nbr = 16, 243 /* Analog Input */ 244 .ai_resolution = 12, 245 .ai_resolution_mask = 0x0fff, 246 .ai_range_list = &me2000_ai_range, 247 .dio_channel_nbr = 32, 248 } 249}; 250 251#define me_board_nbr (sizeof(me_boards)/sizeof(struct me_board)) 252 253static struct comedi_driver me_driver = { 254 .driver_name = ME_DRIVER_NAME, 255 .module = THIS_MODULE, 256 .attach = me_attach, 257 .detach = me_detach, 258}; 259 260static int __devinit me_driver_pci_probe(struct pci_dev *dev, 261 const struct pci_device_id *ent) 262{ 263 return comedi_pci_auto_config(dev, me_driver.driver_name); 264} 265 266static void __devexit me_driver_pci_remove(struct pci_dev *dev) 267{ 268 comedi_pci_auto_unconfig(dev); 269} 270 271static struct pci_driver me_driver_pci_driver = { 272 .id_table = me_pci_table, 273 .probe = &me_driver_pci_probe, 274 .remove = __devexit_p(&me_driver_pci_remove) 275}; 276 277static int __init me_driver_init_module(void) 278{ 279 int retval; 280 281 retval = comedi_driver_register(&me_driver); 282 if (retval < 0) 283 return retval; 284 285 me_driver_pci_driver.name = (char *)me_driver.driver_name; 286 return pci_register_driver(&me_driver_pci_driver); 287} 288 289static void __exit me_driver_cleanup_module(void) 290{ 291 pci_unregister_driver(&me_driver_pci_driver); 292 comedi_driver_unregister(&me_driver); 293} 294 295module_init(me_driver_init_module); 296module_exit(me_driver_cleanup_module); 297 298/* Private data structure */ 299struct me_private_data { 300 struct pci_dev *pci_device; 301 void __iomem *plx_regbase; /* PLX configuration base address */ 302 void __iomem *me_regbase; /* Base address of the Meilhaus card */ 303 unsigned long plx_regbase_size; /* Size of PLX configuration space */ 304 unsigned long me_regbase_size; /* Size of Meilhaus space */ 305 306 unsigned short control_1; /* Mirror of CONTROL_1 register */ 307 unsigned short control_2; /* Mirror of CONTROL_2 register */ 308 unsigned short dac_control; /* Mirror of the DAC_CONTROL register */ 309 int ao_readback[4]; /* Mirror of analog output data */ 310}; 311 312#define dev_private ((struct me_private_data *)dev->private) 313 314/* 315 * ------------------------------------------------------------------ 316 * 317 * Helpful functions 318 * 319 * ------------------------------------------------------------------ 320 */ 321static inline void sleep(unsigned sec) 322{ 323 current->state = TASK_INTERRUPTIBLE; 324 schedule_timeout(sec * HZ); 325} 326 327/* 328 * ------------------------------------------------------------------ 329 * 330 * DIGITAL INPUT/OUTPUT SECTION 331 * 332 * ------------------------------------------------------------------ 333 */ 334static int me_dio_insn_config(struct comedi_device *dev, 335 struct comedi_subdevice *s, 336 struct comedi_insn *insn, unsigned int *data) 337{ 338 int bits; 339 int mask = 1 << CR_CHAN(insn->chanspec); 340 341 /* calculate port */ 342 if (mask & 0x0000ffff) { /* Port A in use */ 343 bits = 0x0000ffff; 344 345 /* Enable Port A */ 346 dev_private->control_2 |= ENABLE_PORT_A; 347 writew(dev_private->control_2, 348 dev_private->me_regbase + ME_CONTROL_2); 349 } else { /* Port B in use */ 350 351 bits = 0xffff0000; 352 353 /* Enable Port B */ 354 dev_private->control_2 |= ENABLE_PORT_B; 355 writew(dev_private->control_2, 356 dev_private->me_regbase + ME_CONTROL_2); 357 } 358 359 if (data[0]) { 360 /* Config port as output */ 361 s->io_bits |= bits; 362 } else { 363 /* Config port as input */ 364 s->io_bits &= ~bits; 365 } 366 367 return 1; 368} 369 370/* Digital instant input/outputs */ 371static int me_dio_insn_bits(struct comedi_device *dev, 372 struct comedi_subdevice *s, 373 struct comedi_insn *insn, unsigned int *data) 374{ 375 unsigned int mask = data[0]; 376 s->state &= ~mask; 377 s->state |= (mask & data[1]); 378 379 mask &= s->io_bits; 380 if (mask & 0x0000ffff) { /* Port A */ 381 writew((s->state & 0xffff), 382 dev_private->me_regbase + ME_DIO_PORT_A); 383 } else { 384 data[1] &= ~0x0000ffff; 385 data[1] |= readw(dev_private->me_regbase + ME_DIO_PORT_A); 386 } 387 388 if (mask & 0xffff0000) { /* Port B */ 389 writew(((s->state >> 16) & 0xffff), 390 dev_private->me_regbase + ME_DIO_PORT_B); 391 } else { 392 data[1] &= ~0xffff0000; 393 data[1] |= readw(dev_private->me_regbase + ME_DIO_PORT_B) << 16; 394 } 395 396 return 2; 397} 398 399/* 400 * ------------------------------------------------------------------ 401 * 402 * ANALOG INPUT SECTION 403 * 404 * ------------------------------------------------------------------ 405 */ 406 407/* Analog instant input */ 408static int me_ai_insn_read(struct comedi_device *dev, 409 struct comedi_subdevice *subdevice, 410 struct comedi_insn *insn, unsigned int *data) 411{ 412 unsigned short value; 413 int chan = CR_CHAN((&insn->chanspec)[0]); 414 int rang = CR_RANGE((&insn->chanspec)[0]); 415 int aref = CR_AREF((&insn->chanspec)[0]); 416 int i; 417 418 /* stop any running conversion */ 419 dev_private->control_1 &= 0xFFFC; 420 writew(dev_private->control_1, dev_private->me_regbase + ME_CONTROL_1); 421 422 /* clear chanlist and ad fifo */ 423 dev_private->control_2 &= ~(ENABLE_ADFIFO | ENABLE_CHANLIST); 424 writew(dev_private->control_2, dev_private->me_regbase + ME_CONTROL_2); 425 426 /* reset any pending interrupt */ 427 writew(0x00, dev_private->me_regbase + ME_RESET_INTERRUPT); 428 429 /* enable the chanlist and ADC fifo */ 430 dev_private->control_2 |= (ENABLE_ADFIFO | ENABLE_CHANLIST); 431 writew(dev_private->control_2, dev_private->me_regbase + ME_CONTROL_2); 432 433 /* write to channel list fifo */ 434 /* b3:b0 are the channel number */ 435 value = chan & 0x0f; 436 /* b5:b4 are the channel gain */ 437 value |= (rang & 0x03) << 4; 438 /* b6 channel polarity */ 439 value |= (rang & 0x04) << 4; 440 /* b7 single or differential */ 441 value |= ((aref & AREF_DIFF) ? 0x80 : 0); 442 writew(value & 0xff, dev_private->me_regbase + ME_CHANNEL_LIST); 443 444 /* set ADC mode to software trigger */ 445 dev_private->control_1 |= SOFTWARE_TRIGGERED_ADC; 446 writew(dev_private->control_1, dev_private->me_regbase + ME_CONTROL_1); 447 448 /* start conversion by reading from ADC_START */ 449 readw(dev_private->me_regbase + ME_ADC_START); 450 451 /* wait for ADC fifo not empty flag */ 452 for (i = 100000; i > 0; i--) 453 if (!(readw(dev_private->me_regbase + ME_STATUS) & 0x0004)) 454 break; 455 456 /* get value from ADC fifo */ 457 if (i) { 458 data[0] = 459 (readw(dev_private->me_regbase + 460 ME_READ_AD_FIFO) ^ 0x800) & 0x0FFF; 461 } else { 462 printk(KERN_ERR "comedi%d: Cannot get single value\n", 463 dev->minor); 464 return -EIO; 465 } 466 467 /* stop any running conversion */ 468 dev_private->control_1 &= 0xFFFC; 469 writew(dev_private->control_1, dev_private->me_regbase + ME_CONTROL_1); 470 471 return 1; 472} 473 474/* 475 * ------------------------------------------------------------------ 476 * 477 * HARDWARE TRIGGERED ANALOG INPUT SECTION 478 * 479 * ------------------------------------------------------------------ 480 */ 481 482/* Cancel analog input autoscan */ 483static int me_ai_cancel(struct comedi_device *dev, struct comedi_subdevice *s) 484{ 485 /* disable interrupts */ 486 487 /* stop any running conversion */ 488 dev_private->control_1 &= 0xFFFC; 489 writew(dev_private->control_1, dev_private->me_regbase + ME_CONTROL_1); 490 491 return 0; 492} 493 494/* Test analog input command */ 495static int me_ai_do_cmd_test(struct comedi_device *dev, 496 struct comedi_subdevice *s, struct comedi_cmd *cmd) 497{ 498 return 0; 499} 500 501/* Analog input command */ 502static int me_ai_do_cmd(struct comedi_device *dev, 503 struct comedi_subdevice *subdevice) 504{ 505 return 0; 506} 507 508/* 509 * ------------------------------------------------------------------ 510 * 511 * ANALOG OUTPUT SECTION 512 * 513 * ------------------------------------------------------------------ 514 */ 515 516/* Analog instant output */ 517static int me_ao_insn_write(struct comedi_device *dev, 518 struct comedi_subdevice *s, 519 struct comedi_insn *insn, unsigned int *data) 520{ 521 int chan; 522 int rang; 523 int i; 524 525 /* Enable all DAC */ 526 dev_private->control_2 |= ENABLE_DAC; 527 writew(dev_private->control_2, dev_private->me_regbase + ME_CONTROL_2); 528 529 /* and set DAC to "buffered" mode */ 530 dev_private->control_2 |= BUFFERED_DAC; 531 writew(dev_private->control_2, dev_private->me_regbase + ME_CONTROL_2); 532 533 /* Set dac-control register */ 534 for (i = 0; i < insn->n; i++) { 535 chan = CR_CHAN((&insn->chanspec)[i]); 536 rang = CR_RANGE((&insn->chanspec)[i]); 537 538 /* clear bits for this channel */ 539 dev_private->dac_control &= ~(0x0880 >> chan); 540 if (rang == 0) 541 dev_private->dac_control |= 542 ((DAC_BIPOLAR_A | DAC_GAIN_1_A) >> chan); 543 else if (rang == 1) 544 dev_private->dac_control |= 545 ((DAC_BIPOLAR_A | DAC_GAIN_0_A) >> chan); 546 } 547 writew(dev_private->dac_control, 548 dev_private->me_regbase + ME_DAC_CONTROL); 549 550 /* Update dac-control register */ 551 readw(dev_private->me_regbase + ME_DAC_CONTROL_UPDATE); 552 553 /* Set data register */ 554 for (i = 0; i < insn->n; i++) { 555 chan = CR_CHAN((&insn->chanspec)[i]); 556 writew((data[0] & s->maxdata), 557 dev_private->me_regbase + ME_DAC_DATA_A + (chan << 1)); 558 dev_private->ao_readback[chan] = (data[0] & s->maxdata); 559 } 560 561 /* Update dac with data registers */ 562 readw(dev_private->me_regbase + ME_DAC_UPDATE); 563 564 return i; 565} 566 567/* Analog output readback */ 568static int me_ao_insn_read(struct comedi_device *dev, 569 struct comedi_subdevice *s, struct comedi_insn *insn, 570 unsigned int *data) 571{ 572 int i; 573 574 for (i = 0; i < insn->n; i++) { 575 data[i] = 576 dev_private->ao_readback[CR_CHAN((&insn->chanspec)[i])]; 577 } 578 579 return 1; 580} 581 582/* 583 * ------------------------------------------------------------------ 584 * 585 * INITIALISATION SECTION 586 * 587 * ------------------------------------------------------------------ 588 */ 589 590/* Xilinx firmware download for card: ME-2600i */ 591static int me2600_xilinx_download(struct comedi_device *dev, 592 unsigned char *me2600_firmware, 593 unsigned int length) 594{ 595 unsigned int value; 596 unsigned int file_length; 597 unsigned int i; 598 599 /* disable irq's on PLX */ 600 writel(0x00, dev_private->plx_regbase + PLX_INTCSR); 601 602 /* First, make a dummy read to reset xilinx */ 603 value = readw(dev_private->me_regbase + XILINX_DOWNLOAD_RESET); 604 605 /* Wait until reset is over */ 606 sleep(1); 607 608 /* Write a dummy value to Xilinx */ 609 writeb(0x00, dev_private->me_regbase + 0x0); 610 sleep(1); 611 612 /* 613 * Format of the firmware 614 * Build longs from the byte-wise coded header 615 * Byte 1-3: length of the array 616 * Byte 4-7: version 617 * Byte 8-11: date 618 * Byte 12-15: reserved 619 */ 620 if (length < 16) 621 return -EINVAL; 622 file_length = (((unsigned int)me2600_firmware[0] & 0xff) << 24) + 623 (((unsigned int)me2600_firmware[1] & 0xff) << 16) + 624 (((unsigned int)me2600_firmware[2] & 0xff) << 8) + 625 ((unsigned int)me2600_firmware[3] & 0xff); 626 627 /* 628 * Loop for writing firmware byte by byte to xilinx 629 * Firmware data start at offfset 16 630 */ 631 for (i = 0; i < file_length; i++) 632 writeb((me2600_firmware[16 + i] & 0xff), 633 dev_private->me_regbase + 0x0); 634 635 /* Write 5 dummy values to xilinx */ 636 for (i = 0; i < 5; i++) 637 writeb(0x00, dev_private->me_regbase + 0x0); 638 639 /* Test if there was an error during download -> INTB was thrown */ 640 value = readl(dev_private->plx_regbase + PLX_INTCSR); 641 if (value & 0x20) { 642 /* Disable interrupt */ 643 writel(0x00, dev_private->plx_regbase + PLX_INTCSR); 644 printk(KERN_ERR "comedi%d: Xilinx download failed\n", 645 dev->minor); 646 return -EIO; 647 } 648 649 /* Wait until the Xilinx is ready for real work */ 650 sleep(1); 651 652 /* Enable PLX-Interrupts */ 653 writel(0x43, dev_private->plx_regbase + PLX_INTCSR); 654 655 return 0; 656} 657 658/* Reset device */ 659static int me_reset(struct comedi_device *dev) 660{ 661 /* Reset board */ 662 writew(0x00, dev_private->me_regbase + ME_CONTROL_1); 663 writew(0x00, dev_private->me_regbase + ME_CONTROL_2); 664 writew(0x00, dev_private->me_regbase + ME_RESET_INTERRUPT); 665 writew(0x00, dev_private->me_regbase + ME_DAC_CONTROL); 666 667 /* Save values in the board context */ 668 dev_private->dac_control = 0; 669 dev_private->control_1 = 0; 670 dev_private->control_2 = 0; 671 672 return 0; 673} 674 675/* 676 * Attach 677 * 678 * - Register PCI device 679 * - Declare device driver capability 680 */ 681static int me_attach(struct comedi_device *dev, struct comedi_devconfig *it) 682{ 683 struct pci_dev *pci_device; 684 struct comedi_subdevice *subdevice; 685 struct me_board *board; 686 resource_size_t plx_regbase_tmp; 687 unsigned long plx_regbase_size_tmp; 688 resource_size_t me_regbase_tmp; 689 unsigned long me_regbase_size_tmp; 690 resource_size_t swap_regbase_tmp; 691 unsigned long swap_regbase_size_tmp; 692 resource_size_t regbase_tmp; 693 int result, error, i; 694 695 /* Allocate private memory */ 696 if (alloc_private(dev, sizeof(struct me_private_data)) < 0) 697 return -ENOMEM; 698 699 /* Probe the device to determine what device in the series it is. */ 700 for (pci_device = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL); 701 pci_device != NULL; 702 pci_device = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, pci_device)) { 703 if (pci_device->vendor == PCI_VENDOR_ID_MEILHAUS) { 704 for (i = 0; i < me_board_nbr; i++) { 705 if (me_boards[i].device_id == 706 pci_device->device) { 707 /* 708 * was a particular bus/slot requested? 709 */ 710 if ((it->options[0] != 0) 711 || (it->options[1] != 0)) { 712 /* 713 * are we on the wrong bus/slot? 714 */ 715 if (pci_device->bus->number != 716 it->options[0] 717 || 718 PCI_SLOT(pci_device->devfn) 719 != it->options[1]) { 720 continue; 721 } 722 } 723 724 dev->board_ptr = me_boards + i; 725 board = 726 (struct me_board *)dev->board_ptr; 727 dev_private->pci_device = pci_device; 728 goto found; 729 } 730 } 731 } 732 } 733 734 printk(KERN_ERR 735 "comedi%d: no supported board found! (req. bus/slot : %d/%d)\n", 736 dev->minor, it->options[0], it->options[1]); 737 return -EIO; 738 739found: 740 printk(KERN_INFO "comedi%d: found %s at PCI bus %d, slot %d\n", 741 dev->minor, me_boards[i].name, 742 pci_device->bus->number, PCI_SLOT(pci_device->devfn)); 743 744 /* Enable PCI device and request PCI regions */ 745 if (comedi_pci_enable(pci_device, ME_DRIVER_NAME) < 0) { 746 printk(KERN_ERR "comedi%d: Failed to enable PCI device and " 747 "request regions\n", dev->minor); 748 return -EIO; 749 } 750 751 /* Set data in device structure */ 752 dev->board_name = board->name; 753 754 /* Read PLX register base address [PCI_BASE_ADDRESS #0]. */ 755 plx_regbase_tmp = pci_resource_start(pci_device, 0); 756 plx_regbase_size_tmp = pci_resource_len(pci_device, 0); 757 dev_private->plx_regbase = 758 ioremap(plx_regbase_tmp, plx_regbase_size_tmp); 759 dev_private->plx_regbase_size = plx_regbase_size_tmp; 760 if (!dev_private->plx_regbase) { 761 printk("comedi%d: Failed to remap I/O memory\n", dev->minor); 762 return -ENOMEM; 763 } 764 765 /* Read Swap base address [PCI_BASE_ADDRESS #5]. */ 766 767 swap_regbase_tmp = pci_resource_start(pci_device, 5); 768 swap_regbase_size_tmp = pci_resource_len(pci_device, 5); 769 770 if (!swap_regbase_tmp) 771 printk(KERN_ERR "comedi%d: Swap not present\n", dev->minor); 772 773 /*---------------------------------------------- Workaround start ---*/ 774 if (plx_regbase_tmp & 0x0080) { 775 printk(KERN_ERR "comedi%d: PLX-Bug detected\n", dev->minor); 776 777 if (swap_regbase_tmp) { 778 regbase_tmp = plx_regbase_tmp; 779 plx_regbase_tmp = swap_regbase_tmp; 780 swap_regbase_tmp = regbase_tmp; 781 782 result = pci_write_config_dword(pci_device, 783 PCI_BASE_ADDRESS_0, 784 plx_regbase_tmp); 785 if (result != PCIBIOS_SUCCESSFUL) 786 return -EIO; 787 788 result = pci_write_config_dword(pci_device, 789 PCI_BASE_ADDRESS_5, 790 swap_regbase_tmp); 791 if (result != PCIBIOS_SUCCESSFUL) 792 return -EIO; 793 } else { 794 plx_regbase_tmp -= 0x80; 795 result = pci_write_config_dword(pci_device, 796 PCI_BASE_ADDRESS_0, 797 plx_regbase_tmp); 798 if (result != PCIBIOS_SUCCESSFUL) 799 return -EIO; 800 } 801 } 802 /*--------------------------------------------- Workaround end -----*/ 803 804 /* Read Meilhaus register base address [PCI_BASE_ADDRESS #2]. */ 805 806 me_regbase_tmp = pci_resource_start(pci_device, 2); 807 me_regbase_size_tmp = pci_resource_len(pci_device, 2); 808 dev_private->me_regbase_size = me_regbase_size_tmp; 809 dev_private->me_regbase = ioremap(me_regbase_tmp, me_regbase_size_tmp); 810 if (!dev_private->me_regbase) { 811 printk(KERN_ERR "comedi%d: Failed to remap I/O memory\n", 812 dev->minor); 813 return -ENOMEM; 814 } 815 /* Download firmware and reset card */ 816 if (board->device_id == ME2600_DEVICE_ID) { 817 unsigned char *aux_data; 818 int aux_len; 819 820 aux_data = comedi_aux_data(it->options, 0); 821 aux_len = it->options[COMEDI_DEVCONF_AUX_DATA_LENGTH]; 822 823 if (!aux_data || aux_len < 1) { 824 comedi_error(dev, "You must provide me2600 firmware " 825 "using the --init-data option of " 826 "comedi_config"); 827 return -EINVAL; 828 } 829 me2600_xilinx_download(dev, aux_data, aux_len); 830 } 831 832 me_reset(dev); 833 834 /* device driver capabilities */ 835 error = alloc_subdevices(dev, 3); 836 if (error < 0) 837 return error; 838 839 subdevice = dev->subdevices + 0; 840 subdevice->type = COMEDI_SUBD_AI; 841 subdevice->subdev_flags = SDF_READABLE | SDF_COMMON | SDF_CMD_READ; 842 subdevice->n_chan = board->ai_channel_nbr; 843 subdevice->maxdata = board->ai_resolution_mask; 844 subdevice->len_chanlist = board->ai_channel_nbr; 845 subdevice->range_table = board->ai_range_list; 846 subdevice->cancel = me_ai_cancel; 847 subdevice->insn_read = me_ai_insn_read; 848 subdevice->do_cmdtest = me_ai_do_cmd_test; 849 subdevice->do_cmd = me_ai_do_cmd; 850 851 subdevice = dev->subdevices + 1; 852 subdevice->type = COMEDI_SUBD_AO; 853 subdevice->subdev_flags = SDF_WRITEABLE | SDF_COMMON; 854 subdevice->n_chan = board->ao_channel_nbr; 855 subdevice->maxdata = board->ao_resolution_mask; 856 subdevice->len_chanlist = board->ao_channel_nbr; 857 subdevice->range_table = board->ao_range_list; 858 subdevice->insn_read = me_ao_insn_read; 859 subdevice->insn_write = me_ao_insn_write; 860 861 subdevice = dev->subdevices + 2; 862 subdevice->type = COMEDI_SUBD_DIO; 863 subdevice->subdev_flags = SDF_READABLE | SDF_WRITEABLE; 864 subdevice->n_chan = board->dio_channel_nbr; 865 subdevice->maxdata = 1; 866 subdevice->len_chanlist = board->dio_channel_nbr; 867 subdevice->range_table = &range_digital; 868 subdevice->insn_bits = me_dio_insn_bits; 869 subdevice->insn_config = me_dio_insn_config; 870 subdevice->io_bits = 0; 871 872 printk(KERN_INFO "comedi%d: " ME_DRIVER_NAME " attached.\n", 873 dev->minor); 874 return 0; 875} 876 877/* Detach */ 878static int me_detach(struct comedi_device *dev) 879{ 880 if (dev_private) { 881 if (dev_private->me_regbase) { 882 me_reset(dev); 883 iounmap(dev_private->me_regbase); 884 } 885 if (dev_private->plx_regbase) 886 iounmap(dev_private->plx_regbase); 887 if (dev_private->pci_device) { 888 if (dev_private->plx_regbase_size) 889 comedi_pci_disable(dev_private->pci_device); 890 891 pci_dev_put(dev_private->pci_device); 892 } 893 } 894 return 0; 895} 896 897MODULE_AUTHOR("Comedi http://www.comedi.org"); 898MODULE_DESCRIPTION("Comedi low-level driver"); 899MODULE_LICENSE("GPL"); 900