release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/staging/comedi/drivers/serial2002.c

   1 /*
   2     comedi/drivers/serial2002.c
   3     Skeleton code for a Comedi driver
   4
   5     COMEDI - Linux Control and Measurement Device Interface
   6     Copyright (C) 2002 Anders Blomdell <anders.blomdell@control.lth.se>
   7
   8     This program is free software; you can redistribute it and/or modify
   9     it under the terms of the GNU General Public License as published by
  10     the Free Software Foundation; either version 2 of the License, or
  11     (at your option) any later version.
  12
  13     This program is distributed in the hope that it will be useful,
  14     but WITHOUT ANY WARRANTY; without even the implied warranty of
  15     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16     GNU General Public License for more details.
  17
  18     You should have received a copy of the GNU General Public License
  19     along with this program; if not, write to the Free Software
  20     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21
  22 */
  23
  24 /*
  25 Driver: serial2002
  26 Description: Driver for serial connected hardware
  27 Devices:
  28 Author: Anders Blomdell
  29 Updated: Fri,  7 Jun 2002 12:56:45 -0700
  30 Status: in development
  31
  32 */
  33
  34 #include "../comedidev.h"
  35
  36 #include <linux/delay.h>
  37 #include <linux/ioport.h>
  38 #include <linux/sched.h>
  39 #include <linux/slab.h>
  40
  41 #include <asm/termios.h>
  42 #include <asm/ioctls.h>
  43 #include <linux/serial.h>
  44 #include <linux/poll.h>
  45
  46 /*
  47  * Board descriptions for two imaginary boards.  Describing the
  48  * boards in this way is optional, and completely driver-dependent.
  49  * Some drivers use arrays such as this, other do not.
  50  */
  51 struct serial2002_board {
  52         const char *name;
  53 };
  54
  55 static const struct serial2002_board serial2002_boards[] = {
  56         {
  57          .name = "serial2002"}
  58 };
  59
  60 /*
  61  * Useful for shorthand access to the particular board structure
  62  */
  63 #define thisboard ((const struct serial2002_board *)dev->board_ptr)
  64
  65 struct serial2002_range_table_t {
  66
  67         /*  HACK... */
  68         int length;
  69         struct comedi_krange range;
  70 };
  71
  72 struct serial2002_private {
  73
  74         int port;               /*  /dev/ttyS<port> */
  75         int speed;              /*  baudrate */
  76         struct file *tty;
  77         unsigned int ao_readback[32];
  78         unsigned char digital_in_mapping[32];
  79         unsigned char digital_out_mapping[32];
  80         unsigned char analog_in_mapping[32];
  81         unsigned char analog_out_mapping[32];
  82         unsigned char encoder_in_mapping[32];
  83         struct serial2002_range_table_t in_range[32], out_range[32];
  84 };
  85
  86 /*
  87  * most drivers define the following macro to make it easy to
  88  * access the private structure.
  89  */
  90 #define devpriv ((struct serial2002_private *)dev->private)
  91
  92 static int serial2002_attach(struct comedi_device *dev,
  93                              struct comedi_devconfig *it);
  94 static int serial2002_detach(struct comedi_device *dev);
  95 struct comedi_driver driver_serial2002 = {
  96         .driver_name = "serial2002",
  97         .module = THIS_MODULE,
  98         .attach = serial2002_attach,
  99         .detach = serial2002_detach,
 100         .board_name = &serial2002_boards[0].name,
 101         .offset = sizeof(struct serial2002_board),
 102         .num_names = ARRAY_SIZE(serial2002_boards),
 103 };
 104
 105 static int serial2002_di_rinsn(struct comedi_device *dev,
 106                                struct comedi_subdevice *s,
 107                                struct comedi_insn *insn, unsigned int *data);
 108 static int serial2002_do_winsn(struct comedi_device *dev,
 109                                struct comedi_subdevice *s,
 110                                struct comedi_insn *insn, unsigned int *data);
 111 static int serial2002_ai_rinsn(struct comedi_device *dev,
 112                                struct comedi_subdevice *s,
 113                                struct comedi_insn *insn, unsigned int *data);
 114 static int serial2002_ao_winsn(struct comedi_device *dev,
 115                                struct comedi_subdevice *s,
 116                                struct comedi_insn *insn, unsigned int *data);
 117 static int serial2002_ao_rinsn(struct comedi_device *dev,
 118                                struct comedi_subdevice *s,
 119                                struct comedi_insn *insn, unsigned int *data);
 120
 121 struct serial_data {
 122         enum { is_invalid, is_digital, is_channel } kind;
 123         int index;
 124         unsigned long value;
 125 };
 126
 127 static long tty_ioctl(struct file *f, unsigned op, unsigned long param)
 128 {
 129         if (f->f_op->unlocked_ioctl)
 130                 return f->f_op->unlocked_ioctl(f, op, param);
 131
 132         return -ENOSYS;
 133 }
 134
 135 static int tty_write(struct file *f, unsigned char *buf, int count)
 136 {
 137         int result;
 138         mm_segment_t oldfs;
 139
 140         oldfs = get_fs();
 141         set_fs(KERNEL_DS);
 142         f->f_pos = 0;
 143         result = f->f_op->write(f, buf, count, &f->f_pos);
 144         set_fs(oldfs);
 145         return result;
 146 }
 147
 148
 149 static int tty_read(struct file *f, int timeout)
 150 {
 151         int result;
 152
 153         result = -1;
 154         if (!IS_ERR(f)) {
 155                 mm_segment_t oldfs;
 156
 157                 oldfs = get_fs();
 158                 set_fs(KERNEL_DS);
 159                 if (f->f_op->poll) {
 160                         struct poll_wqueues table;
 161                         struct timeval start, now;
 162
 163                         do_gettimeofday(&start);
 164                         poll_initwait(&table);
 165                         while (1) {
 166                                 long elapsed;
 167                                 int mask;
 168
 169                                 mask = f->f_op->poll(f, &table.pt);
 170                                 if (mask & (POLLRDNORM | POLLRDBAND | POLLIN |
 171                                             POLLHUP | POLLERR)) {
 172                                         break;
 173                                 }
 174                                 do_gettimeofday(&now);
 175                                 elapsed =
 176                                     (1000000 * (now.tv_sec - start.tv_sec) +
 177                                      now.tv_usec - start.tv_usec);
 178                                 if (elapsed > timeout) {
 179                                         break;
 180                                 }
 181                                 set_current_state(TASK_INTERRUPTIBLE);
 182                                 schedule_timeout(((timeout -
 183                                                    elapsed) * HZ) / 10000);
 184                         }
 185                         poll_freewait(&table);
 186                         {
 187                                 unsigned char ch;
 188
 189                                 f->f_pos = 0;
 190                                 if (f->f_op->read(f, &ch, 1, &f->f_pos) == 1) {
 191                                         result = ch;
 192                                 }
 193                         }
 194                 } else {
 195                         /* Device does not support poll, busy wait */
 196                         int retries = 0;
 197                         while (1) {
 198                                 unsigned char ch;
 199
 200                                 retries++;
 201                                 if (retries >= timeout) {
 202                                         break;
 203                                 }
 204
 205                                 f->f_pos = 0;
 206                                 if (f->f_op->read(f, &ch, 1, &f->f_pos) == 1) {
 207                                         result = ch;
 208                                         break;
 209                                 }
 210                                 udelay(100);
 211                         }
 212                 }
 213                 set_fs(oldfs);
 214         }
 215         return result;
 216 }
 217
 218 static void tty_setspeed(struct file *f, int speed)
 219 {
 220         mm_segment_t oldfs;
 221
 222         oldfs = get_fs();
 223         set_fs(KERNEL_DS);
 224         {
 225                 /*  Set speed */
 226                 struct termios settings;
 227
 228                 tty_ioctl(f, TCGETS, (unsigned long)&settings);
 229 /* printk("Speed: %d\n", settings.c_cflag & (CBAUD | CBAUDEX)); */
 230                 settings.c_iflag = 0;
 231                 settings.c_oflag = 0;
 232                 settings.c_lflag = 0;
 233                 settings.c_cflag = CLOCAL | CS8 | CREAD;
 234                 settings.c_cc[VMIN] = 0;
 235                 settings.c_cc[VTIME] = 0;
 236                 switch (speed) {
 237                 case 2400:{
 238                                 settings.c_cflag |= B2400;
 239                         }
 240                         break;
 241                 case 4800:{
 242                                 settings.c_cflag |= B4800;
 243                         }
 244                         break;
 245                 case 9600:{
 246                                 settings.c_cflag |= B9600;
 247                         }
 248                         break;
 249                 case 19200:{
 250                                 settings.c_cflag |= B19200;
 251                         }
 252                         break;
 253                 case 38400:{
 254                                 settings.c_cflag |= B38400;
 255                         }
 256                         break;
 257                 case 57600:{
 258                                 settings.c_cflag |= B57600;
 259                         }
 260                         break;
 261                 case 115200:{
 262                                 settings.c_cflag |= B115200;
 263                         }
 264                         break;
 265                 default:{
 266                                 settings.c_cflag |= B9600;
 267                         }
 268                         break;
 269                 }
 270                 tty_ioctl(f, TCSETS, (unsigned long)&settings);
 271 /* printk("Speed: %d\n", settings.c_cflag & (CBAUD | CBAUDEX)); */
 272         }
 273         {
 274                 /*  Set low latency */
 275                 struct serial_struct settings;
 276
 277                 tty_ioctl(f, TIOCGSERIAL, (unsigned long)&settings);
 278                 settings.flags |= ASYNC_LOW_LATENCY;
 279                 tty_ioctl(f, TIOCSSERIAL, (unsigned long)&settings);
 280         }
 281
 282         set_fs(oldfs);
 283 }
 284
 285 static void poll_digital(struct file *f, int channel)
 286 {
 287         char cmd;
 288
 289         cmd = 0x40 | (channel & 0x1f);
 290         tty_write(f, &cmd, 1);
 291 }
 292
 293 static void poll_channel(struct file *f, int channel)
 294 {
 295         char cmd;
 296
 297         cmd = 0x60 | (channel & 0x1f);
 298         tty_write(f, &cmd, 1);
 299 }
 300
 301 static struct serial_data serial_read(struct file *f, int timeout)
 302 {
 303         struct serial_data result;
 304         int length;
 305
 306         result.kind = is_invalid;
 307         result.index = 0;
 308         result.value = 0;
 309         length = 0;
 310         while (1) {
 311                 int data = tty_read(f, timeout);
 312
 313                 length++;
 314                 if (data < 0) {
 315                         printk("serial2002 error\n");
 316                         break;
 317                 } else if (data & 0x80) {
 318                         result.value = (result.value << 7) | (data & 0x7f);
 319                 } else {
 320                         if (length == 1) {
 321                                 switch ((data >> 5) & 0x03) {
 322                                 case 0:{
 323                                                 result.value = 0;
 324                                                 result.kind = is_digital;
 325                                         }
 326                                         break;
 327                                 case 1:{
 328                                                 result.value = 1;
 329                                                 result.kind = is_digital;
 330                                         }
 331                                         break;
 332                                 }
 333                         } else {
 334                                 result.value =
 335                                     (result.value << 2) | ((data & 0x60) >> 5);
 336                                 result.kind = is_channel;
 337                         }
 338                         result.index = data & 0x1f;
 339                         break;
 340                 }
 341         }
 342         return result;
 343
 344 }
 345
 346 static void serial_write(struct file *f, struct serial_data data)
 347 {
 348         if (data.kind == is_digital) {
 349                 unsigned char ch =
 350                     ((data.value << 5) & 0x20) | (data.index & 0x1f);
 351                 tty_write(f, &ch, 1);
 352         } else {
 353                 unsigned char ch[6];
 354                 int i = 0;
 355                 if (data.value >= (1L << 30)) {
 356                         ch[i] = 0x80 | ((data.value >> 30) & 0x03);
 357                         i++;
 358                 }
 359                 if (data.value >= (1L << 23)) {
 360                         ch[i] = 0x80 | ((data.value >> 23) & 0x7f);
 361                         i++;
 362                 }
 363                 if (data.value >= (1L << 16)) {
 364                         ch[i] = 0x80 | ((data.value >> 16) & 0x7f);
 365                         i++;
 366                 }
 367                 if (data.value >= (1L << 9)) {
 368                         ch[i] = 0x80 | ((data.value >> 9) & 0x7f);
 369                         i++;
 370                 }
 371                 ch[i] = 0x80 | ((data.value >> 2) & 0x7f);
 372                 i++;
 373                 ch[i] = ((data.value << 5) & 0x60) | (data.index & 0x1f);
 374                 i++;
 375                 tty_write(f, ch, i);
 376         }
 377 }
 378
 379 static int serial_2002_open(struct comedi_device *dev)
 380 {
 381         int result;
 382         char port[20];
 383
 384         sprintf(port, "/dev/ttyS%d", devpriv->port);
 385         devpriv->tty = filp_open(port, O_RDWR, 0);
 386         if (IS_ERR(devpriv->tty)) {
 387                 result = (int)PTR_ERR(devpriv->tty);
 388                 printk("serial_2002: file open error = %d\n", result);
 389         } else {
 390                 struct config_t {
 391
 392                         short int kind;
 393                         short int bits;
 394                         int min;
 395                         int max;
 396                 };
 397
 398                 struct config_t *dig_in_config;
 399                 struct config_t *dig_out_config;
 400                 struct config_t *chan_in_config;
 401                 struct config_t *chan_out_config;
 402                 int i;
 403
 404                 result = 0;
 405                 dig_in_config = kcalloc(32, sizeof(struct config_t),
 406                                 GFP_KERNEL);
 407                 dig_out_config = kcalloc(32, sizeof(struct config_t),
 408                                 GFP_KERNEL);
 409                 chan_in_config = kcalloc(32, sizeof(struct config_t),
 410                                 GFP_KERNEL);
 411                 chan_out_config = kcalloc(32, sizeof(struct config_t),
 412                                 GFP_KERNEL);
 413                 if (!dig_in_config || !dig_out_config
 414                     || !chan_in_config || !chan_out_config) {
 415                         result = -ENOMEM;
 416                         goto err_alloc_configs;
 417                 }
 418
 419                 tty_setspeed(devpriv->tty, devpriv->speed);
 420                 poll_channel(devpriv->tty, 31); /*  Start reading configuration */
 421                 while (1) {
 422                         struct serial_data data;
 423
 424                         data = serial_read(devpriv->tty, 1000);
 425                         if (data.kind != is_channel || data.index != 31
 426                             || !(data.value & 0xe0)) {
 427                                 break;
 428                         } else {
 429                                 int command, channel, kind;
 430                                 struct config_t *cur_config = NULL;
 431
 432                                 channel = data.value & 0x1f;
 433                                 kind = (data.value >> 5) & 0x7;
 434                                 command = (data.value >> 8) & 0x3;
 435                                 switch (kind) {
 436                                 case 1:{
 437                                                 cur_config = dig_in_config;
 438                                         }
 439                                         break;
 440                                 case 2:{
 441                                                 cur_config = dig_out_config;
 442                                         }
 443                                         break;
 444                                 case 3:{
 445                                                 cur_config = chan_in_config;
 446                                         }
 447                                         break;
 448                                 case 4:{
 449                                                 cur_config = chan_out_config;
 450                                         }
 451                                         break;
 452                                 case 5:{
 453                                                 cur_config = chan_in_config;
 454                                         }
 455                                         break;
 456                                 }
 457
 458                                 if (cur_config) {
 459                                         cur_config[channel].kind = kind;
 460                                         switch (command) {
 461                                         case 0:{
 462                                                         cur_config[channel].bits
 463                                                             =
 464                                                             (data.value >> 10) &
 465                                                             0x3f;
 466                                                 }
 467                                                 break;
 468                                         case 1:{
 469                                                         int unit, sign, min;
 470                                                         unit =
 471                                                             (data.value >> 10) &
 472                                                             0x7;
 473                                                         sign =
 474                                                             (data.value >> 13) &
 475                                                             0x1;
 476                                                         min =
 477                                                             (data.value >> 14) &
 478                                                             0xfffff;
 479
 480                                                         switch (unit) {
 481                                                         case 0:{
 482                                                                         min =
 483                                                                             min
 484                                                                             *
 485                                                                             1000000;
 486                                                                 }
 487                                                                 break;
 488                                                         case 1:{
 489                                                                         min =
 490                                                                             min
 491                                                                             *
 492                                                                             1000;
 493                                                                 }
 494                                                                 break;
 495                                                         case 2:{
 496                                                                         min =
 497                                                                             min
 498                                                                             * 1;
 499                                                                 }
 500                                                                 break;
 501                                                         }
 502                                                         if (sign) {
 503                                                                 min = -min;
 504                                                         }
 505                                                         cur_config[channel].min
 506                                                             = min;
 507                                                 }
 508                                                 break;
 509                                         case 2:{
 510                                                         int unit, sign, max;
 511                                                         unit =
 512                                                             (data.value >> 10) &
 513                                                             0x7;
 514                                                         sign =
 515                                                             (data.value >> 13) &
 516                                                             0x1;
 517                                                         max =
 518                                                             (data.value >> 14) &
 519                                                             0xfffff;
 520
 521                                                         switch (unit) {
 522                                                         case 0:{
 523                                                                         max =
 524                                                                             max
 525                                                                             *
 526                                                                             1000000;
 527                                                                 }
 528                                                                 break;
 529                                                         case 1:{
 530                                                                         max =
 531                                                                             max
 532                                                                             *
 533                                                                             1000;
 534                                                                 }
 535                                                                 break;
 536                                                         case 2:{
 537                                                                         max =
 538                                                                             max
 539                                                                             * 1;
 540                                                                 }
 541                                                                 break;
 542                                                         }
 543                                                         if (sign) {
 544                                                                 max = -max;
 545                                                         }
 546                                                         cur_config[channel].max
 547                                                             = max;
 548                                                 }
 549                                                 break;
 550                                         }
 551                                 }
 552                         }
 553                 }
 554                 for (i = 0; i <= 4; i++) {
 555                         /*  Fill in subdev data */
 556                         struct config_t *c;
 557                         unsigned char *mapping = NULL;
 558                         struct serial2002_range_table_t *range = NULL;
 559                         int kind = 0;
 560
 561                         switch (i) {
 562                         case 0:{
 563                                         c = dig_in_config;
 564                                         mapping = devpriv->digital_in_mapping;
 565                                         kind = 1;
 566                                 }
 567                                 break;
 568                         case 1:{
 569                                         c = dig_out_config;
 570                                         mapping = devpriv->digital_out_mapping;
 571                                         kind = 2;
 572                                 }
 573                                 break;
 574                         case 2:{
 575                                         c = chan_in_config;
 576                                         mapping = devpriv->analog_in_mapping;
 577                                         range = devpriv->in_range;
 578                                         kind = 3;
 579                                 }
 580                                 break;
 581                         case 3:{
 582                                         c = chan_out_config;
 583                                         mapping = devpriv->analog_out_mapping;
 584                                         range = devpriv->out_range;
 585                                         kind = 4;
 586                                 }
 587                                 break;
 588                         case 4:{
 589                                         c = chan_in_config;
 590                                         mapping = devpriv->encoder_in_mapping;
 591                                         range = devpriv->in_range;
 592                                         kind = 5;
 593                                 }
 594                                 break;
 595                         default:{
 596                                         c = NULL;
 597                                 }
 598                                 break;
 599                         }
 600                         if (c) {
 601                                 struct comedi_subdevice *s;
 602                                 const struct comedi_lrange **range_table_list =
 603                                     NULL;
 604                                 unsigned int *maxdata_list;
 605                                 int j, chan;
 606
 607                                 for (chan = 0, j = 0; j < 32; j++) {
 608                                         if (c[j].kind == kind) {
 609                                                 chan++;
 610                                         }
 611                                 }
 612                                 s = &dev->subdevices[i];
 613                                 s->n_chan = chan;
 614                                 s->maxdata = 0;
 615                                 kfree(s->maxdata_list);
 616                                 s->maxdata_list = maxdata_list =
 617                                     kmalloc(sizeof(unsigned int) * s->n_chan,
 618                                             GFP_KERNEL);
 619                                 if (!s->maxdata_list)
 620                                         break;  /* error handled below */
 621                                 kfree(s->range_table_list);
 622                                 s->range_table = NULL;
 623                                 s->range_table_list = NULL;
 624                                 if (range) {
 625                                         s->range_table_list = range_table_list =
 626                                             kmalloc(sizeof
 627                                                     (struct
 628                                                      serial2002_range_table_t) *
 629                                                     s->n_chan, GFP_KERNEL);
 630                                         if (!s->range_table_list)
 631                                                 break;  /* err handled below */
 632                                 }
 633                                 for (chan = 0, j = 0; j < 32; j++) {
 634                                         if (c[j].kind == kind) {
 635                                                 if (mapping) {
 636                                                         mapping[chan] = j;
 637                                                 }
 638                                                 if (range) {
 639                                                         range[j].length = 1;
 640                                                         range[j].range.min =
 641                                                             c[j].min;
 642                                                         range[j].range.max =
 643                                                             c[j].max;
 644                                                         range_table_list[chan] =
 645                                                             (const struct
 646                                                              comedi_lrange *)
 647                                                             &range[j];
 648                                                 }
 649                                                 maxdata_list[chan] =
 650                                                     ((long long)1 << c[j].bits)
 651                                                     - 1;
 652                                                 chan++;
 653                                         }
 654                                 }
 655                         }
 656                 }
 657                 if (i <= 4) {
 658                         /* Failed to allocate maxdata_list or range_table_list
 659                          * for a subdevice that needed it.  */
 660                         result = -ENOMEM;
 661                         for (i = 0; i <= 4; i++) {
 662                                 struct comedi_subdevice *s;
 663
 664                                 s = &dev->subdevices[i];
 665                                 kfree(s->maxdata_list);
 666                                 s->maxdata_list = NULL;
 667                                 kfree(s->range_table_list);
 668                                 s->range_table_list = NULL;
 669                         }
 670                 }
 671
 672 err_alloc_configs:
 673                 kfree(dig_in_config);
 674                 kfree(dig_out_config);
 675                 kfree(chan_in_config);
 676                 kfree(chan_out_config);
 677
 678                 if (result) {
 679                         if (devpriv->tty) {
 680                                 filp_close(devpriv->tty, 0);
 681                                 devpriv->tty = NULL;
 682                         }
 683                 }
 684         }
 685         return result;
 686 }
 687
 688 static void serial_2002_close(struct comedi_device *dev)
 689 {
 690         if (!IS_ERR(devpriv->tty) && (devpriv->tty != 0)) {
 691                 filp_close(devpriv->tty, 0);
 692         }
 693 }
 694
 695 static int serial2002_di_rinsn(struct comedi_device *dev,
 696                                struct comedi_subdevice *s,
 697                                struct comedi_insn *insn, unsigned int *data)
 698 {
 699         int n;
 700         int chan;
 701
 702         chan = devpriv->digital_in_mapping[CR_CHAN(insn->chanspec)];
 703         for (n = 0; n < insn->n; n++) {
 704                 struct serial_data read;
 705
 706                 poll_digital(devpriv->tty, chan);
 707                 while (1) {
 708                         read = serial_read(devpriv->tty, 1000);
 709                         if (read.kind != is_digital || read.index == chan) {
 710                                 break;
 711                         }
 712                 }
 713                 data[n] = read.value;
 714         }
 715         return n;
 716 }
 717
 718 static int serial2002_do_winsn(struct comedi_device *dev,
 719                                struct comedi_subdevice *s,
 720                                struct comedi_insn *insn, unsigned int *data)
 721 {
 722         int n;
 723         int chan;
 724
 725         chan = devpriv->digital_out_mapping[CR_CHAN(insn->chanspec)];
 726         for (n = 0; n < insn->n; n++) {
 727                 struct serial_data write;
 728
 729                 write.kind = is_digital;
 730                 write.index = chan;
 731                 write.value = data[n];
 732                 serial_write(devpriv->tty, write);
 733         }
 734         return n;
 735 }
 736
 737 static int serial2002_ai_rinsn(struct comedi_device *dev,
 738                                struct comedi_subdevice *s,
 739                                struct comedi_insn *insn, unsigned int *data)
 740 {
 741         int n;
 742         int chan;
 743
 744         chan = devpriv->analog_in_mapping[CR_CHAN(insn->chanspec)];
 745         for (n = 0; n < insn->n; n++) {
 746                 struct serial_data read;
 747
 748                 poll_channel(devpriv->tty, chan);
 749                 while (1) {
 750                         read = serial_read(devpriv->tty, 1000);
 751                         if (read.kind != is_channel || read.index == chan) {
 752                                 break;
 753                         }
 754                 }
 755                 data[n] = read.value;
 756         }
 757         return n;
 758 }
 759
 760 static int serial2002_ao_winsn(struct comedi_device *dev,
 761                                struct comedi_subdevice *s,
 762                                struct comedi_insn *insn, unsigned int *data)
 763 {
 764         int n;
 765         int chan;
 766
 767         chan = devpriv->analog_out_mapping[CR_CHAN(insn->chanspec)];
 768         for (n = 0; n < insn->n; n++) {
 769                 struct serial_data write;
 770
 771                 write.kind = is_channel;
 772                 write.index = chan;
 773                 write.value = data[n];
 774                 serial_write(devpriv->tty, write);
 775                 devpriv->ao_readback[chan] = data[n];
 776         }
 777         return n;
 778 }
 779
 780 static int serial2002_ao_rinsn(struct comedi_device *dev,
 781                                struct comedi_subdevice *s,
 782                                struct comedi_insn *insn, unsigned int *data)
 783 {
 784         int n;
 785         int chan = CR_CHAN(insn->chanspec);
 786
 787         for (n = 0; n < insn->n; n++) {
 788                 data[n] = devpriv->ao_readback[chan];
 789         }
 790
 791         return n;
 792 }
 793
 794 static int serial2002_ei_rinsn(struct comedi_device *dev,
 795                                struct comedi_subdevice *s,
 796                                struct comedi_insn *insn, unsigned int *data)
 797 {
 798         int n;
 799         int chan;
 800
 801         chan = devpriv->encoder_in_mapping[CR_CHAN(insn->chanspec)];
 802         for (n = 0; n < insn->n; n++) {
 803                 struct serial_data read;
 804
 805                 poll_channel(devpriv->tty, chan);
 806                 while (1) {
 807                         read = serial_read(devpriv->tty, 1000);
 808                         if (read.kind != is_channel || read.index == chan) {
 809                                 break;
 810                         }
 811                 }
 812                 data[n] = read.value;
 813         }
 814         return n;
 815 }
 816
 817 static int serial2002_attach(struct comedi_device *dev,
 818                              struct comedi_devconfig *it)
 819 {
 820         struct comedi_subdevice *s;
 821
 822         printk("comedi%d: serial2002: ", dev->minor);
 823         dev->board_name = thisboard->name;
 824         if (alloc_private(dev, sizeof(struct serial2002_private)) < 0) {
 825                 return -ENOMEM;
 826         }
 827         dev->open = serial_2002_open;
 828         dev->close = serial_2002_close;
 829         devpriv->port = it->options[0];
 830         devpriv->speed = it->options[1];
 831         printk("/dev/ttyS%d @ %d\n", devpriv->port, devpriv->speed);
 832
 833         if (alloc_subdevices(dev, 5) < 0)
 834                 return -ENOMEM;
 835
 836         /* digital input subdevice */
 837         s = dev->subdevices + 0;
 838         s->type = COMEDI_SUBD_DI;
 839         s->subdev_flags = SDF_READABLE;
 840         s->n_chan = 0;
 841         s->maxdata = 1;
 842         s->range_table = &range_digital;
 843         s->insn_read = &serial2002_di_rinsn;
 844
 845         /* digital output subdevice */
 846         s = dev->subdevices + 1;
 847         s->type = COMEDI_SUBD_DO;
 848         s->subdev_flags = SDF_WRITEABLE;
 849         s->n_chan = 0;
 850         s->maxdata = 1;
 851         s->range_table = &range_digital;
 852         s->insn_write = &serial2002_do_winsn;
 853
 854         /* analog input subdevice */
 855         s = dev->subdevices + 2;
 856         s->type = COMEDI_SUBD_AI;
 857         s->subdev_flags = SDF_READABLE | SDF_GROUND;
 858         s->n_chan = 0;
 859         s->maxdata = 1;
 860         s->range_table = 0;
 861         s->insn_read = &serial2002_ai_rinsn;
 862
 863         /* analog output subdevice */
 864         s = dev->subdevices + 3;
 865         s->type = COMEDI_SUBD_AO;
 866         s->subdev_flags = SDF_WRITEABLE;
 867         s->n_chan = 0;
 868         s->maxdata = 1;
 869         s->range_table = 0;
 870         s->insn_write = &serial2002_ao_winsn;
 871         s->insn_read = &serial2002_ao_rinsn;
 872
 873         /* encoder input subdevice */
 874         s = dev->subdevices + 4;
 875         s->type = COMEDI_SUBD_COUNTER;
 876         s->subdev_flags = SDF_READABLE | SDF_LSAMPL;
 877         s->n_chan = 0;
 878         s->maxdata = 1;
 879         s->range_table = 0;
 880         s->insn_read = &serial2002_ei_rinsn;
 881
 882         return 1;
 883 }
 884
 885 static int serial2002_detach(struct comedi_device *dev)
 886 {
 887         struct comedi_subdevice *s;
 888         int i;
 889
 890         printk("comedi%d: serial2002: remove\n", dev->minor);
 891         for (i = 0; i < 5; i++) {
 892                 s = &dev->subdevices[i];
 893                 if (s->maxdata_list) {
 894                         kfree(s->maxdata_list);
 895                 }
 896                 if (s->range_table_list) {
 897                         kfree(s->range_table_list);
 898                 }
 899         }
 900         return 0;
 901 }
 902
 903 static int __init driver_serial2002_init_module(void)
 904 {
 905         return comedi_driver_register(&driver_serial2002);
 906 }
 907
 908 static void __exit driver_serial2002_cleanup_module(void)
 909 {
 910         comedi_driver_unregister(&driver_serial2002);
 911 }
 912
 913 module_init(driver_serial2002_init_module);
 914 module_exit(driver_serial2002_cleanup_module);
 915
 916 MODULE_AUTHOR("Comedi http://www.comedi.org");
 917 MODULE_DESCRIPTION("Comedi low-level driver");
 918 MODULE_LICENSE("GPL");