X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/b34a548a5dfd2f0b068fd835a4cd51680d851068..989218c6c2ba15f150dd815acb978b6ca092c85e:/lincan/src/open.c diff --git a/lincan/src/open.c b/lincan/src/open.c index 015b521..219aab9 100644 --- a/lincan/src/open.c +++ b/lincan/src/open.c @@ -1,17 +1,41 @@ -/* open.c - * Linux CAN-bus device driver. - * Written by Arnaud Westenberg email:arnaud@wanadoo.nl - * Rewritten for new CAN queues by Pavel Pisa - OCERA team member - * email:pisa@cmp.felk.cvut.cz - * This software is released under the GPL-License. - * Version lincan-0.2 9 Jul 2003 - */ +/**************************************************************************/ +/* File: open.c - systemcall to open new user connection/handle */ +/* */ +/* 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" #include "../include/open.h" -#include "../include/i82527.h" #include "../include/setup.h" #define __NO_VERSION__ @@ -20,37 +44,55 @@ int can_open(struct inode *inode, struct file *file) { struct msgobj_t *obj; - struct chip_t *chip; + struct canchip_t *chip; struct canuser_t *canuser; struct canque_ends_t *qends; struct canque_edge_t *edge; + can_spin_irqflags_t iflags; + char openflag; // Martin Petera: Object already opened + int minor_nr = INODE2MINOR_NR(inode); - if ( ((obj=objects_p[MINOR_NR]) == NULL) || - ((chip=objects_p[MINOR_NR]->hostchip) == NULL) ) { - CANMSG("There is no hardware support for the device file with minor nr.: %d\n",MINOR_NR); + if ((minor_nr < 0) || (minor_nr >= MAX_TOT_MSGOBJS)) { + CANMSG("can_open: bad minor %d\n", minor_nr); + return -ENODEV; + } + + if ( ((obj=objects_p[minor_nr]) == NULL) || + ((chip=objects_p[minor_nr]->hostchip) == NULL) ) { + CANMSG("There is no hardware support for the device file with minor nr.: %d\n", minor_nr); return -ENODEV; } atomic_inc(&obj->obj_used); - DEBUGMSG("Device %d opened %d times.\n", MINOR_NR, atomic_read(&obj->obj_used)); + DEBUGMSG("Device %d opened %d times.\n", minor_nr, atomic_read(&obj->obj_used)); + openflag = can_msgobj_test_fl(obj,OPENED); // Martin Petera: store previous status can_msgobj_set_fl(obj,OPENED); - if (chip->flags & CHIP_CONFIGURED) + if (chip->flags & CHIP_CONFIGURED) DEBUGMSG("Device is already configured.\n"); else { if (chip->chipspecops->chip_config(chip)) CANMSG("Error configuring chip.\n"); else - chip->flags |= CHIP_CONFIGURED; + chip->flags |= CHIP_CONFIGURED; + } /* End of chip configuration */ + + /* Martin Petera: Fix for HCAN2 + * pre_read was called only once -> Opening second MSG object from userspace + * didn't call function to configure MSG object for receive. + * FIX: Call pre_read once for each MSG object + **/ + if (!openflag) { if (chip->chipspecops->pre_read_config(chip,obj)<0) CANMSG("Error initializing chip for receiving\n"); + } - } /* End of chip configuration */ canuser = (struct canuser_t *)kmalloc(sizeof(struct canuser_t), GFP_KERNEL); if(canuser == NULL) goto no_canuser; - canuser->file = file; + canuser->flags=0; + canuser->userinfo.fileinfo.file = file; canuser->msgobj = obj; canuser->magic = CAN_USER_MAGIC; file->private_data = canuser; @@ -59,8 +101,11 @@ int can_open(struct inode *inode, struct file *file) if(qends == NULL) goto no_qends; canqueue_ends_init_kern(qends); canuser->qends = qends; - + + /*required to synchronize with RT-Linux context*/ + can_spin_lock_irqsave(&canuser_manipulation_lock, iflags); list_add(&canuser->peers, &obj->obj_users); + can_spin_unlock_irqrestore(&canuser_manipulation_lock, iflags); if(canqueue_connect_edge(edge=canque_new_edge_kern(MAX_BUF_LENGTH), canuser->qends, obj->qends)<0) goto no_tx_qedge; @@ -73,10 +118,10 @@ int can_open(struct inode *inode, struct file *file) #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,50)) MOD_INC_USE_COUNT; -#endif +#endif return 0; - + no_rx_qedge: canque_notify_bothends(edge, CANQUEUE_NOTIFY_DEAD_WANTED); canque_edge_decref(edge);