lincan/src/ioctl.c

   1 /* ioctl.c
   2  * Linux CAN-bus device driver.
   3  * Written by Arnaud Westenberg email:arnaud@wanadoo.nl
   4  * Rewritten for new CAN queues by Pavel Pisa - OCERA team member
   5  * email:pisa@cmp.felk.cvut.cz
   6  * This software is released under the GPL-License.
   7  * Version lincan-0.2  9 Jul 2003
   8  */
   9
  10 #include "../include/can.h"
  11 #include "../include/can_sysdep.h"
  12 #include "../include/main.h"
  13 #include "../include/ioctl.h"
  14 #include "../include/i82527.h"
  15
  16 int can_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  17 {
  18         int i=0;
  19         unsigned short channel=0;
  20         unsigned btr0=0, btr1=0;
  21         struct canuser_t *canuser = (struct canuser_t*)(file->private_data);
  22         struct msgobj_t *obj;
  23         struct chip_t *chip;
  24         struct canque_ends_t *qends;
  25
  26         if(!canuser || (canuser->magic != CAN_USER_MAGIC)){
  27                 CANMSG("can_ioctl: bad canuser magic\n");
  28                 return -ENODEV;
  29         }
  30
  31         obj = canuser->msgobj;
  32         if (obj == NULL) {
  33                 CANMSG("Could not assign buffer structure\n");
  34                 return -1;
  35         }
  36
  37         qends = canuser->qends;
  38         chip = obj->hostchip;
  39         if (chip == NULL) {
  40                 CANMSG("Device is not correctly configured.\n");
  41                 CANMSG("Please reload the driver.\n");
  42                 return -1;
  43         }
  44
  45         switch (cmd) {
  46                 case CAN_DRV_QUERY: {
  47                         return can_ioctl_query(canuser, arg);
  48                 }
  49                 case STAT: {
  50                         for (i=0x0; i<0x100; i++)
  51                                 CANMSG("0x%x is 0x%x\n",i,can_read_reg(chip,i));
  52                         break;
  53                 }
  54                 case CMD_START: {
  55                         if (chip->chipspecops->start_chip(chip))
  56                                 return -1;
  57                         break;
  58                 }
  59                 case CMD_STOP: {
  60                         if (chip->chipspecops->stop_chip(chip))
  61                                 return -1;
  62                         break;
  63                 }
  64                 case CANQUE_FLUSH: {
  65                         canque_flush(canuser->rx_edge0);
  66                         break;
  67                 }
  68                 case CONF_FILTER: {
  69                     #if 0
  70                         if (!strcmp(chip->chip_type,"i82527")) {
  71
  72                                 unsigned char id1, id0;
  73                                 id1 = (unsigned char) (arg << 5);
  74                                 id0 = (unsigned char) (arg >> 3);
  75
  76                                 DEBUGMSG("configuring ID=%lx in message object:"
  77                                         " %02x, %02x\n", arg, id0, id1);
  78                                 can_write_reg(chip,id1,MSG_OFFSET(obj->object) +
  79                                                                 iMSGID1);
  80                                 can_write_reg(chip,id0,MSG_OFFSET(obj->object) +
  81                                                                 iMSGID0);
  82                         }
  83                     #endif
  84
  85                         /* In- and output buffer re-initialization */
  86
  87                         if(canuser->rx_edge0){
  88                                 canque_set_filt(canuser->rx_edge0, arg, ~0, 0);
  89                         }
  90
  91                         break;
  92                 }
  93
  94                 case CANQUE_FILTER: {
  95                         struct canfilt_t canfilt;
  96                         copy_from_user(&canfilt, (void*)arg, sizeof(struct canfilt_t));
  97                         if(canuser->rx_edge0){
  98                                 canque_set_filt(canuser->rx_edge0, canfilt.id, canfilt.mask, canfilt.flags);
  99                         }
 100                         break;
 101                 }
 102
 103                 case CONF_BAUD: {
 104                         channel = arg & 0xff;
 105                         btr0 = (arg >> 8) & 0xff;
 106                         btr1 = (arg >> 16) & 0xff;
 107
 108                         if (chip->chipspecops->set_btregs(chip, btr0, btr1)) {
 109                                 CANMSG("Error setting bit timing registers\n");
 110                                 return -1;
 111                         }
 112                         break;
 113                 }
 114                 default: {
 115                         CANMSG("Not a valid ioctl command\n");
 116                         return -EINVAL;
 117                 }
 118
 119         }
 120
 121         return 0;
 122 }