X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/dd8f5100e766813dca62a82c6b99ebf3648f2448..fe719367cdb25978d42261513dd9810c22481960:/lincan/src/finish.c diff --git a/lincan/src/finish.c b/lincan/src/finish.c index 9016ae8..d1f6a87 100644 --- a/lincan/src/finish.c +++ b/lincan/src/finish.c @@ -1,3 +1,37 @@ +/**************************************************************************/ +/* File: finish.c - finalization of the driver operations */ +/* */ +/* LinCAN - (Not only) Linux CAN bus driver */ +/* Copyright (C) 2002-2009 DCE FEE CTU Prague */ +/* Copyright (C) 2002-2009 Pavel Pisa */ +/* Funded by OCERA and FRESCOR IST projects */ +/* Based on CAN driver code by Arnaud Westenberg */ +/* */ +/* LinCAN is free software; you can redistribute it and/or modify it */ +/* under terms of the GNU General Public License as published by the */ +/* Free Software Foundation; either version 2, or (at your option) any */ +/* later version. LinCAN is distributed in the hope that it will be */ +/* useful, but WITHOUT ANY WARRANTY; without even the implied warranty */ +/* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU */ +/* General Public License for more details. You should have received a */ +/* copy of the GNU General Public License along with LinCAN; see file */ +/* COPYING. If not, write to the Free Software Foundation, 675 Mass Ave, */ +/* Cambridge, MA 02139, USA. */ +/* */ +/* To allow use of LinCAN in the compact embedded systems firmware */ +/* and RT-executives (RTEMS for example), main authors agree with next */ +/* special exception: */ +/* */ +/* Including LinCAN header files in a file, instantiating LinCAN generics */ +/* or templates, or linking other files with LinCAN objects to produce */ +/* an application image/executable, does not by itself cause the */ +/* resulting application image/executable to be covered by */ +/* the GNU General Public License. */ +/* This exception does not however invalidate any other reasons */ +/* why the executable file might be covered by the GNU Public License. */ +/* Publication of enhanced or derived LinCAN files is required although. */ +/**************************************************************************/ + #include "../include/can.h" #include "../include/can_sysdep.h" #include "../include/main.h" @@ -5,7 +39,7 @@ #include "../include/finish.h" #include "../include/setup.h" - +extern int next_minor; /** * msgobj_done - destroys one CAN message object * @obj: pointer to CAN message object structure @@ -23,17 +57,20 @@ void msgobj_done(struct msgobj_t *obj) if(obj->hostchip->msgobj[obj->object-1] == obj) obj->hostchip->msgobj[obj->object-1]=NULL; else - CANMSG("msgobj_done: not registered in the chip_t\n"); + CANMSG("msgobj_done: not registered in the canchip_t\n"); obj->hostchip=NULL; } - + if((obj->minor>=0)) { - if(objects_p[obj->minor] == obj) + if(objects_p[obj->minor] == obj){ objects_p[obj->minor] = NULL; + if (--next_minor<0) + next_minor=0; + } else CANMSG("msgobj_done: not registered as minor\n"); } - + del_timer_sync(&obj->tx_timeout); if(obj->qends) { @@ -51,12 +88,17 @@ void msgobj_done(struct msgobj_t *obj) * canchip_done - destroys one CAN chip representation * @chip: pointer to CAN chip structure */ -void canchip_done(struct chip_t *chip) +void canchip_done(struct canchip_t *chip) { int i; struct msgobj_t *obj; + if(chip->flags & CHIP_ATTACHED){ + chip->chipspecops->release_chip(chip); + chip->flags &= ~CHIP_ATTACHED; + } + if((chip->hostdevice) && (chip->chip_idx>=0)) { if(chip->hostdevice->chip[chip->chip_idx] == chip) chip->hostdevice->chip[chip->chip_idx] = NULL; @@ -65,17 +107,21 @@ void canchip_done(struct chip_t *chip) } can_chip_free_irq(chip); - + can_synchronize_irq(chip->chip_irq); - + for(i=0; imax_objects; i++){ if((obj=chip->msgobj[i])==NULL) continue; msgobj_done(obj); can_checked_free(obj); } - + can_checked_free(chip->chipspecops); + + if(~chip->flags & CHIP_KEEP_DATA) + can_checked_free(chip->chip_data); + chip->chip_data = NULL; chip->chipspecops=NULL; } @@ -87,19 +133,22 @@ void canchip_done(struct chip_t *chip) void candevice_done(struct candevice_t *candev) { int i; - struct chip_t *chip; - + struct canchip_t *chip; + for(i=0; inr_all_chips; i++){ if((chip=candev->chip[i])==NULL) continue; canchip_done(chip); can_checked_free(chip); - + } if(candev->flags & CANDEV_IO_RESERVED) { candev->hwspecops->release_io(candev); candev->flags &= ~CANDEV_IO_RESERVED; } + if(candev->hwspecops->done_hw_data != NULL) + candev->hwspecops->done_hw_data(candev); + can_checked_free(candev->hwspecops); candev->hwspecops=NULL; } @@ -112,8 +161,8 @@ void canhardware_done(struct canhardware_t *canhw) { int i; struct candevice_t *candev; - - for(i=0; inr_boards; i++){ + + for(i=0; icandevice[i])==NULL) continue; candevice_done(candev);