lincan/src/finish.c

   1 #include "../include/can.h"
   2 #include "../include/can_sysdep.h"
   3 #include "../include/main.h"
   4 #include "../include/devcommon.h"
   5 #include "../include/finish.h"
   6 #include "../include/setup.h"
   7
   8
   9
  10 void msgobj_done(struct msgobj_t *obj)
  11 {
  12         int delayed=0;
  13         if(obj->qends) {
  14                 delayed=canqueue_ends_done_chip(obj->qends);
  15                 if(delayed < 0)
  16                         CANMSG("msgobj_done: problem with chip queue ends\n");
  17         }
  18
  19         if((obj->hostchip) && (obj->object>0)) {
  20                 if(obj->hostchip->msgobj[obj->object-1] == obj)
  21                         obj->hostchip->msgobj[obj->object-1]=NULL;
  22                 else
  23                         CANMSG("msgobj_done: not registered in the chip_t\n");
  24                 obj->hostchip=NULL;
  25         }
  26
  27         if((obj->minor>=0)) {
  28                 if(objects_p[obj->minor] == obj)
  29                         objects_p[obj->minor] = NULL;
  30                 else
  31                         CANMSG("msgobj_done: not registered as minor\n");
  32         }
  33
  34         del_timer_sync(&obj->tx_timeout);
  35
  36         if(obj->qends) {
  37                 /*delayed free could be required there in the future,
  38                   actual use patter cannot generate such situation*/
  39                 if(!delayed) {
  40                         can_checked_free(obj->qends);
  41                 }
  42         }
  43         obj->qends=NULL;
  44 }
  45
  46
  47 void canchip_done(struct chip_t *chip)
  48 {
  49
  50         int i;
  51         struct msgobj_t *obj;
  52
  53         if((chip->hostdevice) && (chip->chip_idx>=0)) {
  54                 if(chip->hostdevice->chip[chip->chip_idx] == chip)
  55                         chip->hostdevice->chip[chip->chip_idx] = NULL;
  56                 else
  57                         CANMSG("canchip_done: not registered in hostdevice\n");
  58         }
  59
  60         can_chip_free_irq(chip);
  61
  62         can_synchronize_irq(chip->chip_irq);
  63
  64         for(i=0; i<chip->max_objects; i++){
  65                 if((obj=chip->msgobj[i])==NULL)
  66                         continue;
  67                 msgobj_done(obj);
  68                 can_checked_free(obj);
  69         }
  70
  71         can_checked_free(chip->chipspecops);
  72         chip->chipspecops=NULL;
  73
  74 }
  75
  76 void candevice_done(struct candevice_t *candev)
  77 {
  78         int i;
  79         struct chip_t *chip;
  80
  81         for(i=0; i<candev->nr_all_chips; i++){
  82                 if((chip=candev->chip[i])==NULL)
  83                         continue;
  84                 canchip_done(chip);
  85                 can_checked_free(chip);
  86
  87         }
  88         if(candev->flags & CANDEV_IO_RESERVED) {
  89                 candev->hwspecops->release_io(candev);
  90                 candev->flags &= ~CANDEV_IO_RESERVED;
  91         }
  92         can_checked_free(candev->hwspecops);
  93         candev->hwspecops=NULL;
  94 }
  95
  96 void canhardware_done(struct canhardware_t *canhw)
  97 {
  98         int i;
  99         struct candevice_t *candev;
 100
 101         for(i=0; i<canhw->nr_boards; i++){
 102                 if((candev=canhw->candevice[i])==NULL)
 103                         continue;
 104                 candevice_done(candev);
 105                 can_checked_free(candev);
 106         }
 107
 108 }