1/* 2 3 comedi/drivers/adl_pci9111.c 4 5 Hardware driver for PCI9111 ADLink cards: 6 7 PCI-9111HR 8 9 Copyright (C) 2002-2005 Emmanuel Pacaud <emmanuel.pacaud@univ-poitiers.fr> 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: adl_pci9111 28Description: Adlink PCI-9111HR 29Author: Emmanuel Pacaud <emmanuel.pacaud@univ-poitiers.fr> 30Devices: [ADLink] PCI-9111HR (adl_pci9111) 31Status: experimental 32 33Supports: 34 35 - ai_insn read 36 - ao_insn read/write 37 - di_insn read 38 - do_insn read/write 39 - ai_do_cmd mode with the following sources: 40 41 - start_src TRIG_NOW 42 - scan_begin_src TRIG_FOLLOW TRIG_TIMER TRIG_EXT 43 - convert_src TRIG_TIMER TRIG_EXT 44 - scan_end_src TRIG_COUNT 45 - stop_src TRIG_COUNT TRIG_NONE 46 47 The scanned channels must be consecutive and start from 0. They must 48 all have the same range and aref. 49 50Configuration options: 51 52 [0] - PCI bus number (optional) 53 [1] - PCI slot number (optional) 54 55 If bus/slot is not specified, the first available PCI 56 device will be used. 57 58*/ 59 60/* 61CHANGELOG: 62 63 2005/02/17 Extend AI streaming capabilities. Now, scan_begin_arg can be 64 a multiple of chanlist_len*convert_arg. 65 2002/02/19 Fixed the two's complement conversion in pci9111_(hr_)ai_get_data. 66 2002/02/18 Added external trigger support for analog input. 67 68TODO: 69 70 - Really test implemented functionality. 71 - Add support for the PCI-9111DG with a probe routine to identify the card 72 type (perhaps with the help of the channel number readback of the A/D Data 73 register). 74 - Add external multiplexer support. 75 76*/ 77 78#include "../comedidev.h" 79 80#include <linux/delay.h> 81#include <linux/interrupt.h> 82 83#include "8253.h" 84#include "comedi_pci.h" 85#include "comedi_fc.h" 86 87#define PCI9111_DRIVER_NAME "adl_pci9111" 88#define PCI9111_HR_DEVICE_ID 0x9111 89 90/* TODO: Add other pci9111 board id */ 91 92#define PCI9111_IO_RANGE 0x0100 93 94#define PCI9111_FIFO_HALF_SIZE 512 95 96#define PCI9111_AI_CHANNEL_NBR 16 97 98#define PCI9111_AI_RESOLUTION 12 99#define PCI9111_AI_RESOLUTION_MASK 0x0FFF 100#define PCI9111_AI_RESOLUTION_2_CMP_BIT 0x0800 101 102#define PCI9111_HR_AI_RESOLUTION 16 103#define PCI9111_HR_AI_RESOLUTION_MASK 0xFFFF 104#define PCI9111_HR_AI_RESOLUTION_2_CMP_BIT 0x8000 105 106#define PCI9111_AI_ACQUISITION_PERIOD_MIN_NS 10000 107#define PCI9111_AO_CHANNEL_NBR 1 108#define PCI9111_AO_RESOLUTION 12 109#define PCI9111_AO_RESOLUTION_MASK 0x0FFF 110#define PCI9111_DI_CHANNEL_NBR 16 111#define PCI9111_DO_CHANNEL_NBR 16 112#define PCI9111_DO_MASK 0xFFFF 113 114#define PCI9111_RANGE_SETTING_DELAY 10 115#define PCI9111_AI_INSTANT_READ_UDELAY_US 2 116#define PCI9111_AI_INSTANT_READ_TIMEOUT 100 117 118#define PCI9111_8254_CLOCK_PERIOD_NS 500 119 120#define PCI9111_8254_COUNTER_0 0x00 121#define PCI9111_8254_COUNTER_1 0x40 122#define PCI9111_8254_COUNTER_2 0x80 123#define PCI9111_8254_COUNTER_LATCH 0x00 124#define PCI9111_8254_READ_LOAD_LSB_ONLY 0x10 125#define PCI9111_8254_READ_LOAD_MSB_ONLY 0x20 126#define PCI9111_8254_READ_LOAD_LSB_MSB 0x30 127#define PCI9111_8254_MODE_0 0x00 128#define PCI9111_8254_MODE_1 0x02 129#define PCI9111_8254_MODE_2 0x04 130#define PCI9111_8254_MODE_3 0x06 131#define PCI9111_8254_MODE_4 0x08 132#define PCI9111_8254_MODE_5 0x0A 133#define PCI9111_8254_BINARY_COUNTER 0x00 134#define PCI9111_8254_BCD_COUNTER 0x01 135 136/* IO address map */ 137 138#define PCI9111_REGISTER_AD_FIFO_VALUE 0x00 /* AD Data stored 139 in FIFO */ 140#define PCI9111_REGISTER_DA_OUTPUT 0x00 141#define PCI9111_REGISTER_DIGITAL_IO 0x02 142#define PCI9111_REGISTER_EXTENDED_IO_PORTS 0x04 143#define PCI9111_REGISTER_AD_CHANNEL_CONTROL 0x06 /* Channel 144 selection */ 145#define PCI9111_REGISTER_AD_CHANNEL_READBACK 0x06 146#define PCI9111_REGISTER_INPUT_SIGNAL_RANGE 0x08 147#define PCI9111_REGISTER_RANGE_STATUS_READBACK 0x08 148#define PCI9111_REGISTER_TRIGGER_MODE_CONTROL 0x0A 149#define PCI9111_REGISTER_AD_MODE_INTERRUPT_READBACK 0x0A 150#define PCI9111_REGISTER_SOFTWARE_TRIGGER 0x0E 151#define PCI9111_REGISTER_INTERRUPT_CONTROL 0x0C 152#define PCI9111_REGISTER_8254_COUNTER_0 0x40 153#define PCI9111_REGISTER_8254_COUNTER_1 0x42 154#define PCI9111_REGISTER_8254_COUNTER_2 0X44 155#define PCI9111_REGISTER_8254_CONTROL 0x46 156#define PCI9111_REGISTER_INTERRUPT_CLEAR 0x48 157 158#define PCI9111_TRIGGER_MASK 0x0F 159#define PCI9111_PTRG_OFF (0 << 3) 160#define PCI9111_PTRG_ON (1 << 3) 161#define PCI9111_EITS_EXTERNAL (1 << 2) 162#define PCI9111_EITS_INTERNAL (0 << 2) 163#define PCI9111_TPST_SOFTWARE_TRIGGER (0 << 1) 164#define PCI9111_TPST_TIMER_PACER (1 << 1) 165#define PCI9111_ASCAN_ON (1 << 0) 166#define PCI9111_ASCAN_OFF (0 << 0) 167 168#define PCI9111_ISC0_SET_IRQ_ON_ENDING_OF_AD_CONVERSION (0 << 0) 169#define PCI9111_ISC0_SET_IRQ_ON_FIFO_HALF_FULL (1 << 0) 170#define PCI9111_ISC1_SET_IRQ_ON_TIMER_TICK (0 << 1) 171#define PCI9111_ISC1_SET_IRQ_ON_EXT_TRG (1 << 1) 172#define PCI9111_FFEN_SET_FIFO_ENABLE (0 << 2) 173#define PCI9111_FFEN_SET_FIFO_DISABLE (1 << 2) 174 175#define PCI9111_CHANNEL_MASK 0x0F 176 177#define PCI9111_RANGE_MASK 0x07 178#define PCI9111_FIFO_EMPTY_MASK 0x10 179#define PCI9111_FIFO_HALF_FULL_MASK 0x20 180#define PCI9111_FIFO_FULL_MASK 0x40 181#define PCI9111_AD_BUSY_MASK 0x80 182 183#define PCI9111_IO_BASE (dev->iobase) 184 185/* 186 * Define inlined function 187 */ 188 189#define pci9111_trigger_and_autoscan_get() \ 190 (inb(PCI9111_IO_BASE+PCI9111_REGISTER_AD_MODE_INTERRUPT_READBACK)&0x0F) 191 192#define pci9111_trigger_and_autoscan_set(flags) \ 193 outb(flags, PCI9111_IO_BASE+PCI9111_REGISTER_TRIGGER_MODE_CONTROL) 194 195#define pci9111_interrupt_and_fifo_get() \ 196 ((inb(PCI9111_IO_BASE+PCI9111_REGISTER_AD_MODE_INTERRUPT_READBACK) >> 4) \ 197 &0x03) 198 199#define pci9111_interrupt_and_fifo_set(flags) \ 200 outb(flags, PCI9111_IO_BASE+PCI9111_REGISTER_INTERRUPT_CONTROL) 201 202#define pci9111_interrupt_clear() \ 203 outb(0, PCI9111_IO_BASE+PCI9111_REGISTER_INTERRUPT_CLEAR) 204 205#define pci9111_software_trigger() \ 206 outb(0, PCI9111_IO_BASE+PCI9111_REGISTER_SOFTWARE_TRIGGER) 207 208#define pci9111_fifo_reset() do { \ 209 outb(PCI9111_FFEN_SET_FIFO_ENABLE, \ 210 PCI9111_IO_BASE+PCI9111_REGISTER_INTERRUPT_CONTROL); \ 211 outb(PCI9111_FFEN_SET_FIFO_DISABLE, \ 212 PCI9111_IO_BASE+PCI9111_REGISTER_INTERRUPT_CONTROL); \ 213 outb(PCI9111_FFEN_SET_FIFO_ENABLE, \ 214 PCI9111_IO_BASE+PCI9111_REGISTER_INTERRUPT_CONTROL); \ 215 } while (0) 216 217#define pci9111_is_fifo_full() \ 218 ((inb(PCI9111_IO_BASE+PCI9111_REGISTER_RANGE_STATUS_READBACK)& \ 219 PCI9111_FIFO_FULL_MASK) == 0) 220 221#define pci9111_is_fifo_half_full() \ 222 ((inb(PCI9111_IO_BASE+PCI9111_REGISTER_RANGE_STATUS_READBACK)& \ 223 PCI9111_FIFO_HALF_FULL_MASK) == 0) 224 225#define pci9111_is_fifo_empty() \ 226 ((inb(PCI9111_IO_BASE+PCI9111_REGISTER_RANGE_STATUS_READBACK)& \ 227 PCI9111_FIFO_EMPTY_MASK) == 0) 228 229#define pci9111_ai_channel_set(channel) \ 230 outb((channel)&PCI9111_CHANNEL_MASK, \ 231 PCI9111_IO_BASE+PCI9111_REGISTER_AD_CHANNEL_CONTROL) 232 233#define pci9111_ai_channel_get() \ 234 (inb(PCI9111_IO_BASE+PCI9111_REGISTER_AD_CHANNEL_READBACK) \ 235 &PCI9111_CHANNEL_MASK) 236 237#define pci9111_ai_range_set(range) \ 238 outb((range)&PCI9111_RANGE_MASK, \ 239 PCI9111_IO_BASE+PCI9111_REGISTER_INPUT_SIGNAL_RANGE) 240 241#define pci9111_ai_range_get() \ 242 (inb(PCI9111_IO_BASE+PCI9111_REGISTER_RANGE_STATUS_READBACK) \ 243 &PCI9111_RANGE_MASK) 244 245#define pci9111_ai_get_data() \ 246 (((inw(PCI9111_IO_BASE+PCI9111_REGISTER_AD_FIFO_VALUE)>>4) \ 247 &PCI9111_AI_RESOLUTION_MASK) \ 248 ^ PCI9111_AI_RESOLUTION_2_CMP_BIT) 249 250#define pci9111_hr_ai_get_data() \ 251 ((inw(PCI9111_IO_BASE+PCI9111_REGISTER_AD_FIFO_VALUE) \ 252 & PCI9111_HR_AI_RESOLUTION_MASK) \ 253 ^ PCI9111_HR_AI_RESOLUTION_2_CMP_BIT) 254 255#define pci9111_ao_set_data(data) \ 256 outw(data&PCI9111_AO_RESOLUTION_MASK, \ 257 PCI9111_IO_BASE+PCI9111_REGISTER_DA_OUTPUT) 258 259#define pci9111_di_get_bits() \ 260 inw(PCI9111_IO_BASE+PCI9111_REGISTER_DIGITAL_IO) 261 262#define pci9111_do_set_bits(bits) \ 263 outw(bits, PCI9111_IO_BASE+PCI9111_REGISTER_DIGITAL_IO) 264 265#define pci9111_8254_control_set(flags) \ 266 outb(flags, PCI9111_IO_BASE+PCI9111_REGISTER_8254_CONTROL) 267 268#define pci9111_8254_counter_0_set(data) \ 269 outb(data & 0xFF, PCI9111_IO_BASE+PCI9111_REGISTER_8254_COUNTER_0); \ 270 outb((data >> 8) & 0xFF, PCI9111_IO_BASE+PCI9111_REGISTER_8254_COUNTER_0) 271 272#define pci9111_8254_counter_1_set(data) \ 273 outb(data & 0xFF, PCI9111_IO_BASE+PCI9111_REGISTER_8254_COUNTER_1); \ 274 outb((data >> 8) & 0xFF, PCI9111_IO_BASE+PCI9111_REGISTER_8254_COUNTER_1) 275 276#define pci9111_8254_counter_2_set(data) \ 277 outb(data & 0xFF, PCI9111_IO_BASE+PCI9111_REGISTER_8254_COUNTER_2); \ 278 outb((data >> 8) & 0xFF, PCI9111_IO_BASE+PCI9111_REGISTER_8254_COUNTER_2) 279 280/* Function prototypes */ 281 282static int pci9111_attach(struct comedi_device *dev, 283 struct comedi_devconfig *it); 284static int pci9111_detach(struct comedi_device *dev); 285static void pci9111_ai_munge(struct comedi_device *dev, 286 struct comedi_subdevice *s, void *data, 287 unsigned int num_bytes, 288 unsigned int start_chan_index); 289 290static const struct comedi_lrange pci9111_hr_ai_range = { 291 5, 292 { 293 BIP_RANGE(10), 294 BIP_RANGE(5), 295 BIP_RANGE(2.5), 296 BIP_RANGE(1.25), 297 BIP_RANGE(0.625) 298 } 299}; 300 301static DEFINE_PCI_DEVICE_TABLE(pci9111_pci_table) = { 302 { PCI_VENDOR_ID_ADLINK, PCI9111_HR_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID, 303 0, 0, 0 }, 304 /* { PCI_VENDOR_ID_ADLINK, PCI9111_HG_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID, 305 * 0, 0, 0 }, */ 306 { 0 } 307}; 308 309MODULE_DEVICE_TABLE(pci, pci9111_pci_table); 310 311/* */ 312/* Board specification structure */ 313/* */ 314 315struct pci9111_board { 316 const char *name; /* driver name */ 317 int device_id; 318 int ai_channel_nbr; /* num of A/D chans */ 319 int ao_channel_nbr; /* num of D/A chans */ 320 int ai_resolution; /* resolution of A/D */ 321 int ai_resolution_mask; 322 int ao_resolution; /* resolution of D/A */ 323 int ao_resolution_mask; 324 const struct comedi_lrange *ai_range_list; /* rangelist for A/D */ 325 const struct comedi_lrange *ao_range_list; /* rangelist for D/A */ 326 unsigned int ai_acquisition_period_min_ns; 327}; 328 329static const struct pci9111_board pci9111_boards[] = { 330 { 331 .name = "pci9111_hr", 332 .device_id = PCI9111_HR_DEVICE_ID, 333 .ai_channel_nbr = PCI9111_AI_CHANNEL_NBR, 334 .ao_channel_nbr = PCI9111_AO_CHANNEL_NBR, 335 .ai_resolution = PCI9111_HR_AI_RESOLUTION, 336 .ai_resolution_mask = PCI9111_HR_AI_RESOLUTION_MASK, 337 .ao_resolution = PCI9111_AO_RESOLUTION, 338 .ao_resolution_mask = PCI9111_AO_RESOLUTION_MASK, 339 .ai_range_list = &pci9111_hr_ai_range, 340 .ao_range_list = &range_bipolar10, 341 .ai_acquisition_period_min_ns = PCI9111_AI_ACQUISITION_PERIOD_MIN_NS} 342}; 343 344#define pci9111_board_nbr \ 345 (sizeof(pci9111_boards)/sizeof(struct pci9111_board)) 346 347static struct comedi_driver pci9111_driver = { 348 .driver_name = PCI9111_DRIVER_NAME, 349 .module = THIS_MODULE, 350 .attach = pci9111_attach, 351 .detach = pci9111_detach, 352}; 353 354static int __devinit pci9111_driver_pci_probe(struct pci_dev *dev, 355 const struct pci_device_id *ent) 356{ 357 return comedi_pci_auto_config(dev, pci9111_driver.driver_name); 358} 359 360static void __devexit pci9111_driver_pci_remove(struct pci_dev *dev) 361{ 362 comedi_pci_auto_unconfig(dev); 363} 364 365static struct pci_driver pci9111_driver_pci_driver = { 366 .id_table = pci9111_pci_table, 367 .probe = &pci9111_driver_pci_probe, 368 .remove = __devexit_p(&pci9111_driver_pci_remove) 369}; 370 371static int __init pci9111_driver_init_module(void) 372{ 373 int retval; 374 375 retval = comedi_driver_register(&pci9111_driver); 376 if (retval < 0) 377 return retval; 378 379 pci9111_driver_pci_driver.name = (char *)pci9111_driver.driver_name; 380 return pci_register_driver(&pci9111_driver_pci_driver); 381} 382 383static void __exit pci9111_driver_cleanup_module(void) 384{ 385 pci_unregister_driver(&pci9111_driver_pci_driver); 386 comedi_driver_unregister(&pci9111_driver); 387} 388 389module_init(pci9111_driver_init_module); 390module_exit(pci9111_driver_cleanup_module); 391 392/* Private data structure */ 393 394struct pci9111_private_data { 395 struct pci_dev *pci_device; 396 unsigned long io_range; /* PCI6503 io range */ 397 398 unsigned long lcr_io_base; /* Local configuration register base 399 * address */ 400 unsigned long lcr_io_range; 401 402 int stop_counter; 403 int stop_is_none; 404 405 unsigned int scan_delay; 406 unsigned int chanlist_len; 407 unsigned int chunk_counter; 408 unsigned int chunk_num_samples; 409 410 int ao_readback; /* Last written analog output data */ 411 412 unsigned int timer_divisor_1; /* Divisor values for the 8254 timer 413 * pacer */ 414 unsigned int timer_divisor_2; 415 416 int is_valid; /* Is device valid */ 417 418 short ai_bounce_buffer[2 * PCI9111_FIFO_HALF_SIZE]; 419}; 420 421#define dev_private ((struct pci9111_private_data *)dev->private) 422 423/* ------------------------------------------------------------------ */ 424/* PLX9050 SECTION */ 425/* ------------------------------------------------------------------ */ 426 427#define PLX9050_REGISTER_INTERRUPT_CONTROL 0x4c 428 429#define PLX9050_LINTI1_ENABLE (1 << 0) 430#define PLX9050_LINTI1_ACTIVE_HIGH (1 << 1) 431#define PLX9050_LINTI1_STATUS (1 << 2) 432#define PLX9050_LINTI2_ENABLE (1 << 3) 433#define PLX9050_LINTI2_ACTIVE_HIGH (1 << 4) 434#define PLX9050_LINTI2_STATUS (1 << 5) 435#define PLX9050_PCI_INTERRUPT_ENABLE (1 << 6) 436#define PLX9050_SOFTWARE_INTERRUPT (1 << 7) 437 438static void plx9050_interrupt_control(unsigned long io_base, 439 bool LINTi1_enable, 440 bool LINTi1_active_high, 441 bool LINTi2_enable, 442 bool LINTi2_active_high, 443 bool interrupt_enable) 444{ 445 int flags = 0; 446 447 if (LINTi1_enable) 448 flags |= PLX9050_LINTI1_ENABLE; 449 if (LINTi1_active_high) 450 flags |= PLX9050_LINTI1_ACTIVE_HIGH; 451 if (LINTi2_enable) 452 flags |= PLX9050_LINTI2_ENABLE; 453 if (LINTi2_active_high) 454 flags |= PLX9050_LINTI2_ACTIVE_HIGH; 455 456 if (interrupt_enable) 457 flags |= PLX9050_PCI_INTERRUPT_ENABLE; 458 459 outb(flags, io_base + PLX9050_REGISTER_INTERRUPT_CONTROL); 460} 461 462/* ------------------------------------------------------------------ */ 463/* MISCELLANEOUS SECTION */ 464/* ------------------------------------------------------------------ */ 465 466/* 8254 timer */ 467 468static void pci9111_timer_set(struct comedi_device *dev) 469{ 470 pci9111_8254_control_set(PCI9111_8254_COUNTER_0 | 471 PCI9111_8254_READ_LOAD_LSB_MSB | 472 PCI9111_8254_MODE_0 | 473 PCI9111_8254_BINARY_COUNTER); 474 475 pci9111_8254_control_set(PCI9111_8254_COUNTER_1 | 476 PCI9111_8254_READ_LOAD_LSB_MSB | 477 PCI9111_8254_MODE_2 | 478 PCI9111_8254_BINARY_COUNTER); 479 480 pci9111_8254_control_set(PCI9111_8254_COUNTER_2 | 481 PCI9111_8254_READ_LOAD_LSB_MSB | 482 PCI9111_8254_MODE_2 | 483 PCI9111_8254_BINARY_COUNTER); 484 485 udelay(1); 486 487 pci9111_8254_counter_2_set(dev_private->timer_divisor_2); 488 pci9111_8254_counter_1_set(dev_private->timer_divisor_1); 489} 490 491enum pci9111_trigger_sources { 492 software, 493 timer_pacer, 494 external 495}; 496 497static void pci9111_trigger_source_set(struct comedi_device *dev, 498 enum pci9111_trigger_sources source) 499{ 500 int flags; 501 502 flags = pci9111_trigger_and_autoscan_get() & 0x09; 503 504 switch (source) { 505 case software: 506 flags |= PCI9111_EITS_INTERNAL | PCI9111_TPST_SOFTWARE_TRIGGER; 507 break; 508 509 case timer_pacer: 510 flags |= PCI9111_EITS_INTERNAL | PCI9111_TPST_TIMER_PACER; 511 break; 512 513 case external: 514 flags |= PCI9111_EITS_EXTERNAL; 515 break; 516 } 517 518 pci9111_trigger_and_autoscan_set(flags); 519} 520 521static void pci9111_pretrigger_set(struct comedi_device *dev, bool pretrigger) 522{ 523 int flags; 524 525 flags = pci9111_trigger_and_autoscan_get() & 0x07; 526 527 if (pretrigger) 528 flags |= PCI9111_PTRG_ON; 529 530 pci9111_trigger_and_autoscan_set(flags); 531} 532 533static void pci9111_autoscan_set(struct comedi_device *dev, bool autoscan) 534{ 535 int flags; 536 537 flags = pci9111_trigger_and_autoscan_get() & 0x0e; 538 539 if (autoscan) 540 flags |= PCI9111_ASCAN_ON; 541 542 pci9111_trigger_and_autoscan_set(flags); 543} 544 545enum pci9111_ISC0_sources { 546 irq_on_eoc, 547 irq_on_fifo_half_full 548}; 549 550enum pci9111_ISC1_sources { 551 irq_on_timer_tick, 552 irq_on_external_trigger 553}; 554 555static void pci9111_interrupt_source_set(struct comedi_device *dev, 556 enum pci9111_ISC0_sources irq_0_source, 557 enum pci9111_ISC1_sources irq_1_source) 558{ 559 int flags; 560 561 flags = pci9111_interrupt_and_fifo_get() & 0x04; 562 563 if (irq_0_source == irq_on_fifo_half_full) 564 flags |= PCI9111_ISC0_SET_IRQ_ON_FIFO_HALF_FULL; 565 566 if (irq_1_source == irq_on_external_trigger) 567 flags |= PCI9111_ISC1_SET_IRQ_ON_EXT_TRG; 568 569 pci9111_interrupt_and_fifo_set(flags); 570} 571 572/* ------------------------------------------------------------------ */ 573/* HARDWARE TRIGGERED ANALOG INPUT SECTION */ 574/* ------------------------------------------------------------------ */ 575 576/* Cancel analog input autoscan */ 577 578#undef AI_DO_CMD_DEBUG 579 580static int pci9111_ai_cancel(struct comedi_device *dev, 581 struct comedi_subdevice *s) 582{ 583 /* Disable interrupts */ 584 585 plx9050_interrupt_control(dev_private->lcr_io_base, true, true, true, 586 true, false); 587 588 pci9111_trigger_source_set(dev, software); 589 590 pci9111_autoscan_set(dev, false); 591 592 pci9111_fifo_reset(); 593 594#ifdef AI_DO_CMD_DEBUG 595 printk(PCI9111_DRIVER_NAME ": ai_cancel\n"); 596#endif 597 598 return 0; 599} 600 601/* Test analog input command */ 602 603#define pci9111_check_trigger_src(src, flags) do { \ 604 tmp = src; \ 605 src &= flags; \ 606 if (!src || tmp != src) \ 607 error++; \ 608 } while (false); 609 610static int 611pci9111_ai_do_cmd_test(struct comedi_device *dev, 612 struct comedi_subdevice *s, struct comedi_cmd *cmd) 613{ 614 int tmp; 615 int error = 0; 616 int range, reference; 617 int i; 618 struct pci9111_board *board = (struct pci9111_board *)dev->board_ptr; 619 620 /* Step 1 : check if trigger are trivialy valid */ 621 622 pci9111_check_trigger_src(cmd->start_src, TRIG_NOW); 623 pci9111_check_trigger_src(cmd->scan_begin_src, 624 TRIG_TIMER | TRIG_FOLLOW | TRIG_EXT); 625 pci9111_check_trigger_src(cmd->convert_src, TRIG_TIMER | TRIG_EXT); 626 pci9111_check_trigger_src(cmd->scan_end_src, TRIG_COUNT); 627 pci9111_check_trigger_src(cmd->stop_src, TRIG_COUNT | TRIG_NONE); 628 629 if (error) 630 return 1; 631 632 /* step 2 : make sure trigger sources are unique and mutually 633 * compatible */ 634 635 if (cmd->start_src != TRIG_NOW) 636 error++; 637 638 if ((cmd->scan_begin_src != TRIG_TIMER) && 639 (cmd->scan_begin_src != TRIG_FOLLOW) && 640 (cmd->scan_begin_src != TRIG_EXT)) 641 error++; 642 643 if ((cmd->convert_src != TRIG_TIMER) && (cmd->convert_src != TRIG_EXT)) 644 error++; 645 if ((cmd->convert_src == TRIG_TIMER) && 646 !((cmd->scan_begin_src == TRIG_TIMER) || 647 (cmd->scan_begin_src == TRIG_FOLLOW))) 648 error++; 649 if ((cmd->convert_src == TRIG_EXT) && 650 !((cmd->scan_begin_src == TRIG_EXT) || 651 (cmd->scan_begin_src == TRIG_FOLLOW))) 652 error++; 653 654 655 if (cmd->scan_end_src != TRIG_COUNT) 656 error++; 657 if ((cmd->stop_src != TRIG_COUNT) && (cmd->stop_src != TRIG_NONE)) 658 error++; 659 660 if (error) 661 return 2; 662 663 /* Step 3 : make sure arguments are trivialy compatible */ 664 665 if (cmd->chanlist_len < 1) { 666 cmd->chanlist_len = 1; 667 error++; 668 } 669 670 if (cmd->chanlist_len > board->ai_channel_nbr) { 671 cmd->chanlist_len = board->ai_channel_nbr; 672 error++; 673 } 674 675 if ((cmd->start_src == TRIG_NOW) && (cmd->start_arg != 0)) { 676 cmd->start_arg = 0; 677 error++; 678 } 679 680 if ((cmd->convert_src == TRIG_TIMER) && 681 (cmd->convert_arg < board->ai_acquisition_period_min_ns)) { 682 cmd->convert_arg = board->ai_acquisition_period_min_ns; 683 error++; 684 } 685 if ((cmd->convert_src == TRIG_EXT) && (cmd->convert_arg != 0)) { 686 cmd->convert_arg = 0; 687 error++; 688 } 689 690 if ((cmd->scan_begin_src == TRIG_TIMER) && 691 (cmd->scan_begin_arg < board->ai_acquisition_period_min_ns)) { 692 cmd->scan_begin_arg = board->ai_acquisition_period_min_ns; 693 error++; 694 } 695 if ((cmd->scan_begin_src == TRIG_FOLLOW) 696 && (cmd->scan_begin_arg != 0)) { 697 cmd->scan_begin_arg = 0; 698 error++; 699 } 700 if ((cmd->scan_begin_src == TRIG_EXT) && (cmd->scan_begin_arg != 0)) { 701 cmd->scan_begin_arg = 0; 702 error++; 703 } 704 705 if ((cmd->scan_end_src == TRIG_COUNT) && 706 (cmd->scan_end_arg != cmd->chanlist_len)) { 707 cmd->scan_end_arg = cmd->chanlist_len; 708 error++; 709 } 710 711 if ((cmd->stop_src == TRIG_COUNT) && (cmd->stop_arg < 1)) { 712 cmd->stop_arg = 1; 713 error++; 714 } 715 if ((cmd->stop_src == TRIG_NONE) && (cmd->stop_arg != 0)) { 716 cmd->stop_arg = 0; 717 error++; 718 } 719 720 if (error) 721 return 3; 722 723 /* Step 4 : fix up any arguments */ 724 725 if (cmd->convert_src == TRIG_TIMER) { 726 tmp = cmd->convert_arg; 727 i8253_cascade_ns_to_timer_2div(PCI9111_8254_CLOCK_PERIOD_NS, 728 &(dev_private->timer_divisor_1), 729 &(dev_private->timer_divisor_2), 730 &(cmd->convert_arg), 731 cmd->flags & TRIG_ROUND_MASK); 732 if (tmp != cmd->convert_arg) 733 error++; 734 } 735 /* There's only one timer on this card, so the scan_begin timer must */ 736 /* be a multiple of chanlist_len*convert_arg */ 737 738 if (cmd->scan_begin_src == TRIG_TIMER) { 739 740 unsigned int scan_begin_min; 741 unsigned int scan_begin_arg; 742 unsigned int scan_factor; 743 744 scan_begin_min = cmd->chanlist_len * cmd->convert_arg; 745 746 if (cmd->scan_begin_arg != scan_begin_min) { 747 if (scan_begin_min < cmd->scan_begin_arg) { 748 scan_factor = 749 cmd->scan_begin_arg / scan_begin_min; 750 scan_begin_arg = scan_factor * scan_begin_min; 751 if (cmd->scan_begin_arg != scan_begin_arg) { 752 cmd->scan_begin_arg = scan_begin_arg; 753 error++; 754 } 755 } else { 756 cmd->scan_begin_arg = scan_begin_min; 757 error++; 758 } 759 } 760 } 761 762 if (error) 763 return 4; 764 765 /* Step 5 : check channel list */ 766 767 if (cmd->chanlist) { 768 769 range = CR_RANGE(cmd->chanlist[0]); 770 reference = CR_AREF(cmd->chanlist[0]); 771 772 if (cmd->chanlist_len > 1) { 773 for (i = 0; i < cmd->chanlist_len; i++) { 774 if (CR_CHAN(cmd->chanlist[i]) != i) { 775 comedi_error(dev, 776 "entries in chanlist must be consecutive " 777 "channels,counting upwards from 0\n"); 778 error++; 779 } 780 if (CR_RANGE(cmd->chanlist[i]) != range) { 781 comedi_error(dev, 782 "entries in chanlist must all have the same gain\n"); 783 error++; 784 } 785 if (CR_AREF(cmd->chanlist[i]) != reference) { 786 comedi_error(dev, 787 "entries in chanlist must all have the same reference\n"); 788 error++; 789 } 790 } 791 } else { 792 if ((CR_CHAN(cmd->chanlist[0]) > 793 (board->ai_channel_nbr - 1)) 794 || (CR_CHAN(cmd->chanlist[0]) < 0)) { 795 comedi_error(dev, 796 "channel number is out of limits\n"); 797 error++; 798 } 799 } 800 } 801 802 if (error) 803 return 5; 804 805 return 0; 806 807} 808 809/* Analog input command */ 810 811static int pci9111_ai_do_cmd(struct comedi_device *dev, 812 struct comedi_subdevice *subdevice) 813{ 814 struct comedi_cmd *async_cmd = &subdevice->async->cmd; 815 816 if (!dev->irq) { 817 comedi_error(dev, 818 "no irq assigned for PCI9111, cannot do hardware conversion"); 819 return -1; 820 } 821 /* Set channel scan limit */ 822 /* PCI9111 allows only scanning from channel 0 to channel n */ 823 /* TODO: handle the case of an external multiplexer */ 824 825 if (async_cmd->chanlist_len > 1) { 826 pci9111_ai_channel_set((async_cmd->chanlist_len) - 1); 827 pci9111_autoscan_set(dev, true); 828 } else { 829 pci9111_ai_channel_set(CR_CHAN(async_cmd->chanlist[0])); 830 pci9111_autoscan_set(dev, false); 831 } 832 833 /* Set gain */ 834 /* This is the same gain on every channel */ 835 836 pci9111_ai_range_set(CR_RANGE(async_cmd->chanlist[0])); 837 838 /* Set counter */ 839 840 switch (async_cmd->stop_src) { 841 case TRIG_COUNT: 842 dev_private->stop_counter = 843 async_cmd->stop_arg * async_cmd->chanlist_len; 844 dev_private->stop_is_none = 0; 845 break; 846 847 case TRIG_NONE: 848 dev_private->stop_counter = 0; 849 dev_private->stop_is_none = 1; 850 break; 851 852 default: 853 comedi_error(dev, "Invalid stop trigger"); 854 return -1; 855 } 856 857 /* Set timer pacer */ 858 859 dev_private->scan_delay = 0; 860 switch (async_cmd->convert_src) { 861 case TRIG_TIMER: 862 i8253_cascade_ns_to_timer_2div(PCI9111_8254_CLOCK_PERIOD_NS, 863 &(dev_private->timer_divisor_1), 864 &(dev_private->timer_divisor_2), 865 &(async_cmd->convert_arg), 866 async_cmd-> 867 flags & TRIG_ROUND_MASK); 868#ifdef AI_DO_CMD_DEBUG 869 printk(PCI9111_DRIVER_NAME ": divisors = %d, %d\n", 870 dev_private->timer_divisor_1, 871 dev_private->timer_divisor_2); 872#endif 873 874 pci9111_trigger_source_set(dev, software); 875 pci9111_timer_set(dev); 876 pci9111_fifo_reset(); 877 pci9111_interrupt_source_set(dev, irq_on_fifo_half_full, 878 irq_on_timer_tick); 879 pci9111_trigger_source_set(dev, timer_pacer); 880 plx9050_interrupt_control(dev_private->lcr_io_base, true, true, 881 false, true, true); 882 883 if (async_cmd->scan_begin_src == TRIG_TIMER) { 884 dev_private->scan_delay = 885 (async_cmd->scan_begin_arg / 886 (async_cmd->convert_arg * 887 async_cmd->chanlist_len)) - 1; 888 } 889 890 break; 891 892 case TRIG_EXT: 893 894 pci9111_trigger_source_set(dev, external); 895 pci9111_fifo_reset(); 896 pci9111_interrupt_source_set(dev, irq_on_fifo_half_full, 897 irq_on_timer_tick); 898 plx9050_interrupt_control(dev_private->lcr_io_base, true, true, 899 false, true, true); 900 901 break; 902 903 default: 904 comedi_error(dev, "Invalid convert trigger"); 905 return -1; 906 } 907 908 dev_private->stop_counter *= (1 + dev_private->scan_delay); 909 dev_private->chanlist_len = async_cmd->chanlist_len; 910 dev_private->chunk_counter = 0; 911 dev_private->chunk_num_samples = 912 dev_private->chanlist_len * (1 + dev_private->scan_delay); 913 914#ifdef AI_DO_CMD_DEBUG 915 printk(PCI9111_DRIVER_NAME ": start interruptions!\n"); 916 printk(PCI9111_DRIVER_NAME ": trigger source = %2x\n", 917 pci9111_trigger_and_autoscan_get()); 918 printk(PCI9111_DRIVER_NAME ": irq source = %2x\n", 919 pci9111_interrupt_and_fifo_get()); 920 printk(PCI9111_DRIVER_NAME ": ai_do_cmd\n"); 921 printk(PCI9111_DRIVER_NAME ": stop counter = %d\n", 922 dev_private->stop_counter); 923 printk(PCI9111_DRIVER_NAME ": scan delay = %d\n", 924 dev_private->scan_delay); 925 printk(PCI9111_DRIVER_NAME ": chanlist_len = %d\n", 926 dev_private->chanlist_len); 927 printk(PCI9111_DRIVER_NAME ": chunk num samples = %d\n", 928 dev_private->chunk_num_samples); 929#endif 930 931 return 0; 932} 933 934static void pci9111_ai_munge(struct comedi_device *dev, 935 struct comedi_subdevice *s, void *data, 936 unsigned int num_bytes, 937 unsigned int start_chan_index) 938{ 939 unsigned int i, num_samples = num_bytes / sizeof(short); 940 short *array = data; 941 int resolution = 942 ((struct pci9111_board *)dev->board_ptr)->ai_resolution; 943 944 for (i = 0; i < num_samples; i++) { 945 if (resolution == PCI9111_HR_AI_RESOLUTION) 946 array[i] = 947 (array[i] & PCI9111_HR_AI_RESOLUTION_MASK) ^ 948 PCI9111_HR_AI_RESOLUTION_2_CMP_BIT; 949 else 950 array[i] = 951 ((array[i] >> 4) & PCI9111_AI_RESOLUTION_MASK) ^ 952 PCI9111_AI_RESOLUTION_2_CMP_BIT; 953 } 954} 955 956/* ------------------------------------------------------------------ */ 957/* INTERRUPT SECTION */ 958/* ------------------------------------------------------------------ */ 959 960#undef INTERRUPT_DEBUG 961 962static irqreturn_t pci9111_interrupt(int irq, void *p_device) 963{ 964 struct comedi_device *dev = p_device; 965 struct comedi_subdevice *subdevice = dev->read_subdev; 966 struct comedi_async *async; 967 unsigned long irq_flags; 968 unsigned char intcsr; 969 970 if (!dev->attached) { 971 /* Ignore interrupt before device fully attached. */ 972 /* Might not even have allocated subdevices yet! */ 973 return IRQ_NONE; 974 } 975 976 async = subdevice->async; 977 978 spin_lock_irqsave(&dev->spinlock, irq_flags); 979 980 /* Check if we are source of interrupt */ 981 intcsr = inb(dev_private->lcr_io_base + 982 PLX9050_REGISTER_INTERRUPT_CONTROL); 983 if (!(((intcsr & PLX9050_PCI_INTERRUPT_ENABLE) != 0) 984 && (((intcsr & (PLX9050_LINTI1_ENABLE | PLX9050_LINTI1_STATUS)) 985 == (PLX9050_LINTI1_ENABLE | PLX9050_LINTI1_STATUS)) 986 || ((intcsr & (PLX9050_LINTI2_ENABLE | PLX9050_LINTI2_STATUS)) 987 == (PLX9050_LINTI2_ENABLE | PLX9050_LINTI2_STATUS))))) { 988 /* Not the source of the interrupt. */ 989 /* (N.B. not using PLX9050_SOFTWARE_INTERRUPT) */ 990 spin_unlock_irqrestore(&dev->spinlock, irq_flags); 991 return IRQ_NONE; 992 } 993 994 if ((intcsr & (PLX9050_LINTI1_ENABLE | PLX9050_LINTI1_STATUS)) == 995 (PLX9050_LINTI1_ENABLE | PLX9050_LINTI1_STATUS)) { 996 /* Interrupt comes from fifo_half-full signal */ 997 998 if (pci9111_is_fifo_full()) { 999 spin_unlock_irqrestore(&dev->spinlock, irq_flags); 1000 comedi_error(dev, PCI9111_DRIVER_NAME " fifo overflow"); 1001 pci9111_interrupt_clear(); 1002 pci9111_ai_cancel(dev, subdevice); 1003 async->events |= COMEDI_CB_ERROR | COMEDI_CB_EOA; 1004 comedi_event(dev, subdevice); 1005 1006 return IRQ_HANDLED; 1007 } 1008 1009 if (pci9111_is_fifo_half_full()) { 1010 unsigned int num_samples; 1011 unsigned int bytes_written = 0; 1012 1013#ifdef INTERRUPT_DEBUG 1014 printk(PCI9111_DRIVER_NAME ": fifo is half full\n"); 1015#endif 1016 1017 num_samples = 1018 PCI9111_FIFO_HALF_SIZE > 1019 dev_private->stop_counter 1020 && !dev_private-> 1021 stop_is_none ? dev_private->stop_counter : 1022 PCI9111_FIFO_HALF_SIZE; 1023 insw(PCI9111_IO_BASE + PCI9111_REGISTER_AD_FIFO_VALUE, 1024 dev_private->ai_bounce_buffer, num_samples); 1025 1026 if (dev_private->scan_delay < 1) { 1027 bytes_written = 1028 cfc_write_array_to_buffer(subdevice, 1029 dev_private-> 1030 ai_bounce_buffer, 1031 num_samples * 1032 sizeof(short)); 1033 } else { 1034 int position = 0; 1035 int to_read; 1036 1037 while (position < num_samples) { 1038 if (dev_private->chunk_counter < 1039 dev_private->chanlist_len) { 1040 to_read = 1041 dev_private->chanlist_len - 1042 dev_private->chunk_counter; 1043 1044 if (to_read > 1045 num_samples - position) 1046 to_read = 1047 num_samples - 1048 position; 1049 1050 bytes_written += 1051 cfc_write_array_to_buffer 1052 (subdevice, 1053 dev_private->ai_bounce_buffer 1054 + position, 1055 to_read * sizeof(short)); 1056 } else { 1057 to_read = 1058 dev_private->chunk_num_samples 1059 - 1060 dev_private->chunk_counter; 1061 if (to_read > 1062 num_samples - position) 1063 to_read = 1064 num_samples - 1065 position; 1066 1067 bytes_written += 1068 sizeof(short) * to_read; 1069 } 1070 1071 position += to_read; 1072 dev_private->chunk_counter += to_read; 1073 1074 if (dev_private->chunk_counter >= 1075 dev_private->chunk_num_samples) 1076 dev_private->chunk_counter = 0; 1077 } 1078 } 1079 1080 dev_private->stop_counter -= 1081 bytes_written / sizeof(short); 1082 } 1083 } 1084 1085 if ((dev_private->stop_counter == 0) && (!dev_private->stop_is_none)) { 1086 async->events |= COMEDI_CB_EOA; 1087 pci9111_ai_cancel(dev, subdevice); 1088 } 1089 1090 /* Very important, otherwise another interrupt request will be inserted 1091 * and will cause driver hangs on processing interrupt event. */ 1092 1093 pci9111_interrupt_clear(); 1094 1095 spin_unlock_irqrestore(&dev->spinlock, irq_flags); 1096 1097 comedi_event(dev, subdevice); 1098 1099 return IRQ_HANDLED; 1100} 1101 1102/* ------------------------------------------------------------------ */ 1103/* INSTANT ANALOG INPUT OUTPUT SECTION */ 1104/* ------------------------------------------------------------------ */ 1105 1106/* analog instant input */ 1107 1108#undef AI_INSN_DEBUG 1109 1110static int pci9111_ai_insn_read(struct comedi_device *dev, 1111 struct comedi_subdevice *subdevice, 1112 struct comedi_insn *insn, unsigned int *data) 1113{ 1114 int resolution = 1115 ((struct pci9111_board *)dev->board_ptr)->ai_resolution; 1116 1117 int timeout, i; 1118 1119#ifdef AI_INSN_DEBUG 1120 printk(PCI9111_DRIVER_NAME ": ai_insn set c/r/n = %2x/%2x/%2x\n", 1121 CR_CHAN((&insn->chanspec)[0]), 1122 CR_RANGE((&insn->chanspec)[0]), insn->n); 1123#endif 1124 1125 pci9111_ai_channel_set(CR_CHAN((&insn->chanspec)[0])); 1126 1127 if ((pci9111_ai_range_get()) != CR_RANGE((&insn->chanspec)[0])) 1128 pci9111_ai_range_set(CR_RANGE((&insn->chanspec)[0])); 1129 1130 pci9111_fifo_reset(); 1131 1132 for (i = 0; i < insn->n; i++) { 1133 pci9111_software_trigger(); 1134 1135 timeout = PCI9111_AI_INSTANT_READ_TIMEOUT; 1136 1137 while (timeout--) { 1138 if (!pci9111_is_fifo_empty()) 1139 goto conversion_done; 1140 } 1141 1142 comedi_error(dev, "A/D read timeout"); 1143 data[i] = 0; 1144 pci9111_fifo_reset(); 1145 return -ETIME; 1146 1147conversion_done: 1148 1149 if (resolution == PCI9111_HR_AI_RESOLUTION) 1150 data[i] = pci9111_hr_ai_get_data(); 1151 else 1152 data[i] = pci9111_ai_get_data(); 1153 } 1154 1155#ifdef AI_INSN_DEBUG 1156 printk(PCI9111_DRIVER_NAME ": ai_insn get c/r/t = %2x/%2x/%2x\n", 1157 pci9111_ai_channel_get(), 1158 pci9111_ai_range_get(), pci9111_trigger_and_autoscan_get()); 1159#endif 1160 1161 return i; 1162} 1163 1164/* Analog instant output */ 1165 1166static int 1167pci9111_ao_insn_write(struct comedi_device *dev, 1168 struct comedi_subdevice *s, struct comedi_insn *insn, 1169 unsigned int *data) 1170{ 1171 int i; 1172 1173 for (i = 0; i < insn->n; i++) { 1174 pci9111_ao_set_data(data[i]); 1175 dev_private->ao_readback = data[i]; 1176 } 1177 1178 return i; 1179} 1180 1181/* Analog output readback */ 1182 1183static int pci9111_ao_insn_read(struct comedi_device *dev, 1184 struct comedi_subdevice *s, 1185 struct comedi_insn *insn, unsigned int *data) 1186{ 1187 int i; 1188 1189 for (i = 0; i < insn->n; i++) 1190 data[i] = dev_private->ao_readback & PCI9111_AO_RESOLUTION_MASK; 1191 1192 return i; 1193} 1194 1195/* ------------------------------------------------------------------ */ 1196/* DIGITAL INPUT OUTPUT SECTION */ 1197/* ------------------------------------------------------------------ */ 1198 1199/* Digital inputs */ 1200 1201static int pci9111_di_insn_bits(struct comedi_device *dev, 1202 struct comedi_subdevice *subdevice, 1203 struct comedi_insn *insn, unsigned int *data) 1204{ 1205 unsigned int bits; 1206 1207 bits = pci9111_di_get_bits(); 1208 data[1] = bits; 1209 1210 return 2; 1211} 1212 1213/* Digital outputs */ 1214 1215static int pci9111_do_insn_bits(struct comedi_device *dev, 1216 struct comedi_subdevice *subdevice, 1217 struct comedi_insn *insn, unsigned int *data) 1218{ 1219 unsigned int bits; 1220 1221 /* Only set bits that have been masked */ 1222 /* data[0] = mask */ 1223 /* data[1] = bit state */ 1224 1225 data[0] &= PCI9111_DO_MASK; 1226 1227 bits = subdevice->state; 1228 bits &= ~data[0]; 1229 bits |= data[0] & data[1]; 1230 subdevice->state = bits; 1231 1232 pci9111_do_set_bits(bits); 1233 1234 data[1] = bits; 1235 1236 return 2; 1237} 1238 1239/* ------------------------------------------------------------------ */ 1240/* INITIALISATION SECTION */ 1241/* ------------------------------------------------------------------ */ 1242 1243/* Reset device */ 1244 1245static int pci9111_reset(struct comedi_device *dev) 1246{ 1247 /* Set trigger source to software */ 1248 1249 plx9050_interrupt_control(dev_private->lcr_io_base, true, true, true, 1250 true, false); 1251 1252 pci9111_trigger_source_set(dev, software); 1253 pci9111_pretrigger_set(dev, false); 1254 pci9111_autoscan_set(dev, false); 1255 1256 /* Reset 8254 chip */ 1257 1258 dev_private->timer_divisor_1 = 0; 1259 dev_private->timer_divisor_2 = 0; 1260 1261 pci9111_timer_set(dev); 1262 1263 return 0; 1264} 1265 1266/* Attach */ 1267/* - Register PCI device */ 1268/* - Declare device driver capability */ 1269 1270static int pci9111_attach(struct comedi_device *dev, 1271 struct comedi_devconfig *it) 1272{ 1273 struct comedi_subdevice *subdevice; 1274 unsigned long io_base, io_range, lcr_io_base, lcr_io_range; 1275 struct pci_dev *pci_device = NULL; 1276 int error, i; 1277 const struct pci9111_board *board; 1278 1279 if (alloc_private(dev, sizeof(struct pci9111_private_data)) < 0) 1280 return -ENOMEM; 1281 /* Probe the device to determine what device in the series it is. */ 1282 1283 printk("comedi%d: " PCI9111_DRIVER_NAME " driver\n", dev->minor); 1284 1285 for_each_pci_dev(pci_device) { 1286 if (pci_device->vendor == PCI_VENDOR_ID_ADLINK) { 1287 for (i = 0; i < pci9111_board_nbr; i++) { 1288 if (pci9111_boards[i].device_id == 1289 pci_device->device) { 1290 /* was a particular bus/slot 1291 * requested? */ 1292 if ((it->options[0] != 0) 1293 || (it->options[1] != 0)) { 1294 /* are we on the wrong 1295 * bus/slot? */ 1296 if (pci_device->bus->number != 1297 it->options[0] 1298 || 1299 PCI_SLOT(pci_device->devfn) 1300 != it->options[1]) { 1301 continue; 1302 } 1303 } 1304 1305 dev->board_ptr = pci9111_boards + i; 1306 board = 1307 (struct pci9111_board *) 1308 dev->board_ptr; 1309 dev_private->pci_device = pci_device; 1310 goto found; 1311 } 1312 } 1313 } 1314 } 1315 1316 printk("comedi%d: no supported board found! (req. bus/slot : %d/%d)\n", 1317 dev->minor, it->options[0], it->options[1]); 1318 return -EIO; 1319 1320found: 1321 1322 printk("comedi%d: found %s (b:s:f=%d:%d:%d) , irq=%d\n", 1323 dev->minor, 1324 pci9111_boards[i].name, 1325 pci_device->bus->number, 1326 PCI_SLOT(pci_device->devfn), 1327 PCI_FUNC(pci_device->devfn), pci_device->irq); 1328 1329 /* TODO: Warn about non-tested boards. */ 1330 1331 /* Read local configuration register base address 1332 * [PCI_BASE_ADDRESS #1]. */ 1333 1334 lcr_io_base = pci_resource_start(pci_device, 1); 1335 lcr_io_range = pci_resource_len(pci_device, 1); 1336 1337 printk 1338 ("comedi%d: local configuration registers at address 0x%4lx [0x%4lx]\n", 1339 dev->minor, lcr_io_base, lcr_io_range); 1340 1341 /* Enable PCI device and request regions */ 1342 if (comedi_pci_enable(pci_device, PCI9111_DRIVER_NAME) < 0) { 1343 printk 1344 ("comedi%d: Failed to enable PCI device and request regions\n", 1345 dev->minor); 1346 return -EIO; 1347 } 1348 /* Read PCI6308 register base address [PCI_BASE_ADDRESS #2]. */ 1349 1350 io_base = pci_resource_start(pci_device, 2); 1351 io_range = pci_resource_len(pci_device, 2); 1352 1353 printk("comedi%d: 6503 registers at address 0x%4lx [0x%4lx]\n", 1354 dev->minor, io_base, io_range); 1355 1356 dev->iobase = io_base; 1357 dev->board_name = board->name; 1358 dev_private->io_range = io_range; 1359 dev_private->is_valid = 0; 1360 dev_private->lcr_io_base = lcr_io_base; 1361 dev_private->lcr_io_range = lcr_io_range; 1362 1363 pci9111_reset(dev); 1364 1365 /* Irq setup */ 1366 1367 dev->irq = 0; 1368 if (pci_device->irq > 0) { 1369 if (request_irq(pci_device->irq, pci9111_interrupt, 1370 IRQF_SHARED, PCI9111_DRIVER_NAME, dev) != 0) { 1371 printk("comedi%d: unable to allocate irq %u\n", 1372 dev->minor, pci_device->irq); 1373 return -EINVAL; 1374 } 1375 } 1376 dev->irq = pci_device->irq; 1377 1378 /* TODO: Add external multiplexer setup (according to option[2]). */ 1379 1380 error = alloc_subdevices(dev, 4); 1381 if (error < 0) 1382 return error; 1383 1384 subdevice = dev->subdevices + 0; 1385 dev->read_subdev = subdevice; 1386 1387 subdevice->type = COMEDI_SUBD_AI; 1388 subdevice->subdev_flags = SDF_READABLE | SDF_COMMON | SDF_CMD_READ; 1389 1390 /* TODO: Add external multiplexer data */ 1391 /* if (devpriv->usemux) { subdevice->n_chan = devpriv->usemux; } */ 1392 /* else { subdevice->n_chan = this_board->n_aichan; } */ 1393 1394 subdevice->n_chan = board->ai_channel_nbr; 1395 subdevice->maxdata = board->ai_resolution_mask; 1396 subdevice->len_chanlist = board->ai_channel_nbr; 1397 subdevice->range_table = board->ai_range_list; 1398 subdevice->cancel = pci9111_ai_cancel; 1399 subdevice->insn_read = pci9111_ai_insn_read; 1400 subdevice->do_cmdtest = pci9111_ai_do_cmd_test; 1401 subdevice->do_cmd = pci9111_ai_do_cmd; 1402 subdevice->munge = pci9111_ai_munge; 1403 1404 subdevice = dev->subdevices + 1; 1405 subdevice->type = COMEDI_SUBD_AO; 1406 subdevice->subdev_flags = SDF_WRITABLE | SDF_COMMON; 1407 subdevice->n_chan = board->ao_channel_nbr; 1408 subdevice->maxdata = board->ao_resolution_mask; 1409 subdevice->len_chanlist = board->ao_channel_nbr; 1410 subdevice->range_table = board->ao_range_list; 1411 subdevice->insn_write = pci9111_ao_insn_write; 1412 subdevice->insn_read = pci9111_ao_insn_read; 1413 1414 subdevice = dev->subdevices + 2; 1415 subdevice->type = COMEDI_SUBD_DI; 1416 subdevice->subdev_flags = SDF_READABLE; 1417 subdevice->n_chan = PCI9111_DI_CHANNEL_NBR; 1418 subdevice->maxdata = 1; 1419 subdevice->range_table = &range_digital; 1420 subdevice->insn_bits = pci9111_di_insn_bits; 1421 1422 subdevice = dev->subdevices + 3; 1423 subdevice->type = COMEDI_SUBD_DO; 1424 subdevice->subdev_flags = SDF_READABLE | SDF_WRITABLE; 1425 subdevice->n_chan = PCI9111_DO_CHANNEL_NBR; 1426 subdevice->maxdata = 1; 1427 subdevice->range_table = &range_digital; 1428 subdevice->insn_bits = pci9111_do_insn_bits; 1429 1430 dev_private->is_valid = 1; 1431 1432 return 0; 1433} 1434 1435/* Detach */ 1436 1437static int pci9111_detach(struct comedi_device *dev) 1438{ 1439 /* Reset device */ 1440 1441 if (dev->private != NULL) { 1442 if (dev_private->is_valid) 1443 pci9111_reset(dev); 1444 1445 } 1446 /* Release previously allocated irq */ 1447 1448 if (dev->irq != 0) 1449 free_irq(dev->irq, dev); 1450 1451 if (dev_private != NULL && dev_private->pci_device != NULL) { 1452 if (dev->iobase) 1453 comedi_pci_disable(dev_private->pci_device); 1454 pci_dev_put(dev_private->pci_device); 1455 } 1456 1457 return 0; 1458} 1459 1460MODULE_AUTHOR("Comedi http://www.comedi.org"); 1461MODULE_DESCRIPTION("Comedi low-level driver"); 1462MODULE_LICENSE("GPL"); 1463