X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/4cf24de229090b1ab6279570a564d224e13dd706..04ac67cc3cac14cd601daacd0592121ec0b84012:/lincan/src/proc.c

diff --git a/lincan/src/proc.c b/lincan/src/proc.c
index 401148e..7cb69c3 100644
--- a/lincan/src/proc.c
+++ b/lincan/src/proc.c
@@ -1,51 +1,70 @@
-/* proc.c
- * Linux CAN-bus device driver.
- * Written by Arnaud Westenberg email:arnaud@wanadoo.nl
- * This software is released under the GPL-License.
- * Version 0.7  6 Aug 2001
- */ 
-
-#define __NO_VERSION__
-#include <linux/module.h>
-
-#include <linux/autoconf.h>
-#if defined (CONFIG_MODVERSIONS) && !defined (MODVERSIONS)
-#define MODVERSIONS
-#endif
-
-#if defined (MODVERSIONS)
-#include <linux/modversions.h>
-#endif
-
-#include <linux/kernel.h>
-#include <linux/malloc.h>
-#include <linux/proc_fs.h>
-#include <linux/version.h>
-
+/**************************************************************************/
+/* File: proc.c - proc filesystem entries for CAN driver                  */
+/*                                                                        */
+/* LinCAN - (Not only) Linux CAN bus driver                               */
+/* Copyright (C) 2002-2009 DCE FEE CTU Prague <http://dce.felk.cvut.cz>   */
+/* Copyright (C) 2002-2009 Pavel Pisa <pisa@cmp.felk.cvut.cz>             */
+/* Funded by OCERA and FRESCOR IST projects                               */
+/* Based on CAN driver code by Arnaud Westenberg <arnaud@wanadoo.nl>      */
+/*                                                                        */
+/* 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/proc.h"
 #include "../include/setup.h"
 
-int add_channel_to_procdir(void);
+#define __NO_VERSION__
+#include <linux/module.h>
+
+int add_channel_to_procdir(struct candevice_t *candev);
 int remove_channel_from_procdir(void);
-int add_object_to_procdir(void);
-int remove_object_from_procdir(void);
+int add_object_to_procdir(int chip_nr);
+int remove_object_from_procdir(int chip_nr);
 
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
-static int candev_readlink(struct proc_dir_entry *de, char *page);
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,3,0))
+static int can_proc_readlink(struct proc_dir_entry *ent, char *page);
 #endif
 
-static int bc=0; /* static counter for each hardware board */
+#if  LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25)
+#define CAN_PROC_ROOT (&proc_root)
+#else /* >= 2.6.26 */
+#define CAN_PROC_ROOT (NULL)
+#endif /* >= 2.6.26 */
+
 static int cc=0; /* static counter for each CAN chip */
-static int oc=0; /* static counter for each message object */
 
-struct canproc_t can_proc_base;
-struct canproc_t *base=&can_proc_base;
+static struct canproc_t can_proc_base;
+static struct canproc_t *base=&can_proc_base;
 
 /* The following functions are needed only for kernel version 2.2. Kernel
  * version 2.4 already defines them for us.
  */
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,3,0))
 static void can_fill_inode(struct inode *inode, int fill)
 {
 	if (fill)
@@ -54,23 +73,36 @@ static void can_fill_inode(struct inode *inode, int fill)
 		MOD_DEC_USE_COUNT;
 }
 
-static struct proc_dir_entry * new_can_proc_entry(unsigned short inode,
-    const char *name, mode_t mode, nlink_t nlink, struct proc_dir_entry *parent)
+static struct proc_dir_entry * can_create_proc_entry(const char *name, mode_t mode,
+					struct proc_dir_entry *parent)
 {
 	struct proc_dir_entry *new_entry = NULL;
+	char *namestore;
+	int namelen;
+
+	if(!name || !parent)
+		return NULL;
+	namelen=strlen(name);
+	if(!namelen)
+		return NULL;
+
+	new_entry = (struct proc_dir_entry *)
+			can_checked_malloc(sizeof(struct proc_dir_entry)+namelen+1);
 
-	new_entry = (struct proc_dir_entry *) kmalloc(sizeof(struct 
-						proc_dir_entry), GFP_KERNEL);
 	if (new_entry == NULL)
 		return NULL;
 
 	memset(new_entry, 0, sizeof(struct proc_dir_entry));
 
-	new_entry->low_ino = inode;
-	new_entry->namelen = strlen(name);
-	new_entry->name = name;
+	/* Store copy of the proc entry name */
+	namestore = ((char *) new_entry) + sizeof(struct proc_dir_entry);
+	memcpy(namestore, name, namelen + 1);
+
+	new_entry->low_ino = 0;
+	new_entry->namelen = namelen;
+	new_entry->name = namestore;
 	new_entry->mode = mode;
-	new_entry->nlink = nlink;
+	new_entry->nlink = 0;
 	new_entry->fill_inode = can_fill_inode;
 	new_entry->parent = parent;
 
@@ -79,36 +111,84 @@ static struct proc_dir_entry * new_can_proc_entry(unsigned short inode,
 	return new_entry;
 }
 
-int can_remove_proc_entry(struct proc_dir_entry *del, struct proc_dir_entry *parent)
+static int can_remove_proc_entry(struct proc_dir_entry *del, struct proc_dir_entry *parent)
 {
 	if (del != NULL) {
 		proc_unregister(parent, del->low_ino);
-		kfree(del);
-		del = NULL;
+		can_checked_free(del);
 		return 0;
 	}
 	else return -ENODEV;
 }
-#endif // Functions required for kernel 2.2
+
+
+static int can_proc_readlink(struct proc_dir_entry *ent, char *page)
+{
+	char *link_dest = (char*)ent->data;
+
+	strcpy(page, link_dest);
+	return strlen(link_dest);
+}
+
+
+
+/* This compatibility version of proc_symlink does not store local copy of destination */
+static inline struct proc_dir_entry *can_proc_symlink(const char *name,
+                struct proc_dir_entry *parent, const char *dest)
+{
+	struct proc_dir_entry *entry;
+
+
+	entry = can_create_proc_entry(name, S_IFLNK | S_IRUGO | S_IWUGO | S_IXUGO, parent);
+	if (entry == NULL)
+		return NULL;
+	entry->readlink_proc = can_proc_readlink;
+	entry->data = dest;
+	return entry;
+}
+
+#else /* Functions forwarded for kernel 2.4 and above */
+
+static inline struct proc_dir_entry * can_create_proc_entry(const char *name, mode_t mode,
+					struct proc_dir_entry *parent)
+{
+	return create_proc_entry(name, mode, parent);
+}
+
+
+/* This does not fully follow linux 2.4 and 2.6 prototype to simplify 2.2.x compatibility */
+/* The newer kernels use entry name instead of pointer to the entry */
+static int can_remove_proc_entry(struct proc_dir_entry *del, struct proc_dir_entry *parent)
+{
+	if(!del) return -ENODEV;
+	remove_proc_entry(del->name,parent);
+	return 0;
+}
+
+static inline struct proc_dir_entry *can_proc_symlink(const char *name,
+                struct proc_dir_entry *parent, const char *dest)
+{
+	return proc_symlink(name, parent, dest);
+}
+
+#endif /* Functions required for kernel 2.2 */
 
 /* can_init_procdir registers the entire CAN directory tree recursively at
  * the proc system.
  */
 int can_init_procdir(void)
 {
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
-	base->can_proc_entry = new_can_proc_entry(0, "can", S_IFDIR | S_IRUGO | 
-					S_IXUGO, 0, &proc_root);
-#else
-	base->can_proc_entry = create_proc_entry("can", S_IFDIR | S_IRUGO | 
-					S_IXUGO, &proc_root);
-#endif
+	int board;
+	struct candevice_t *candev;
+	base->can_proc_entry = can_create_proc_entry("can", S_IFDIR | S_IRUGO |
+					S_IXUGO, CAN_PROC_ROOT);
 	if (base->can_proc_entry == NULL)
 		return -ENODEV;
 
-	for (bc=0; bc<hardware_p->nr_boards; bc++) {
-		add_channel_to_procdir();
-	} 
+	for (board=0; board<hardware_p->nr_boards; board++) {
+		candev=hardware_p->candevice[board];
+		if(candev) add_channel_to_procdir(candev);
+	}
 
 	return 0;
 }
@@ -116,191 +196,166 @@ int can_init_procdir(void)
 /* can_delete_procdir removes the entire CAN tree from the proc system */
 int can_delete_procdir(void)
 {
-	if (remove_channel_from_procdir()) 
+	if (remove_channel_from_procdir())
 		return -ENODEV;
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
-	if (can_remove_proc_entry(base->can_proc_entry, &proc_root)) 
+	/* name: "can" */
+	if (can_remove_proc_entry(base->can_proc_entry, CAN_PROC_ROOT))
 		return -ENODEV;
-#else
-	remove_proc_entry("can", &proc_root);
-#endif
 
 	return 0;
 }
 
-int add_channel_to_procdir(void)
+static int can_chip_procinfo(char *buf, char **start, off_t offset,
+		 int count, int *eof, void *data)
+{
+	struct canchip_t *chip=data;
+	int len=0;
+
+	/* Generic chip info */
+	len += sprintf(buf+len,"type    : %s\n",chip->chip_type);
+	len += sprintf(buf+len,"index   : %d\n",chip->chip_idx);
+	len += sprintf(buf+len,"irq     : %d\n",chip->chip_irq);
+	len += sprintf(buf+len,"addr    : %lu\n",
+			can_ioptr2ulong(chip->chip_base_addr));
+	len += sprintf(buf+len,"config  : %s\n",
+			(chip->flags & CHIP_CONFIGURED) ? "yes":"no");
+	len += sprintf(buf+len,"clock   : %ld Hz\n",chip->clock);
+	len += sprintf(buf+len,"baud    : %ld\n",chip->baudrate);
+	len += sprintf(buf+len,"num obj : %d\n",chip->max_objects);
+
+
+#if 0
+	/* Chip specific info if available */
+	if(chip->chipspecops->get_info)
+		len += (chip->chipspecops->get_info)(chip,buf+len);
+#endif
+
+	*eof = 1;
+	return len;
+}
+
+
+int add_channel_to_procdir(struct candevice_t *candev)
 {
 	int i=0;
 
-	for (i=0; i < candevices_p[bc]->nr_82527_chips + 
-			candevices_p[bc]->nr_sja1000_chips; i++) {
+	for (i=0; i < candev->nr_all_chips; i++) {
 
 		base->channel[cc] = (struct channelproc_t *)
-			kmalloc(sizeof(struct channelproc_t), GFP_KERNEL);
+			can_checked_malloc(sizeof(struct channelproc_t));
 		if (base->channel[cc] == NULL)
 			return -ENOMEM;
-		else if (add_mem_to_list(base->channel[cc]))
-			return -ENOMEM;
 
 		sprintf(base->channel[cc]->ch_name, "channel%d",cc);
-						
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
-		base->channel[cc]->ch_entry = new_can_proc_entry(0, 
-						base->channel[cc]->ch_name,
-						S_IFDIR | S_IRUGO | S_IXUGO, 0, 
-						base->can_proc_entry);
-#else
-		base->channel[cc]->ch_entry = create_proc_entry(
+
+		base->channel[cc]->ch_entry = can_create_proc_entry(
 						base->channel[cc]->ch_name,
 						S_IFDIR | S_IRUGO |S_IXUGO,
 						base->can_proc_entry);
-#endif
+
 		if (base->channel[cc]->ch_entry == NULL)
 			return -ENODEV;
 
-		add_object_to_procdir();
+		add_object_to_procdir(cc);
+
+		create_proc_read_entry("chip_info",        /* proc entry name */
+				       0,                  /* protection mask, 0->default */
+				       base->channel[cc]->ch_entry,  /* parent dir, NULL->/proc */
+				       can_chip_procinfo,
+				       candev->chip[i]);
 
 		cc++;
-	} 
+	}
 
 	return 0;
 }
 
 int remove_channel_from_procdir(void)
 {
-	
+
 	while (cc != 0) {
 		cc--;
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
+
+		if(!base->channel[cc]) continue;
+
+		remove_proc_entry("chip_info", base->channel[cc]->ch_entry);
+
+		if (remove_object_from_procdir(cc))
+			return -ENODEV;
+
+		/* name: base->channel[cc]->ch_name */
 		if (can_remove_proc_entry(base->channel[cc]->ch_entry,
 							base->can_proc_entry))
 			return -ENODEV;
-#else
-		remove_proc_entry(base->channel[cc]->ch_name,
-							base->can_proc_entry);
-#endif
-		if (remove_object_from_procdir())
-			return -ENODEV; 
+
+		can_checked_free(base->channel[cc]);
+		base->channel[cc] = NULL;
 	}
 
 	return 0;
 }
 
 
-int add_object_to_procdir(void)
+int add_object_to_procdir(int chip_nr)
 {
-	int i=0, obj=0;
+	int i, max_objects;
 
-	if (!strcmp(chips_p[cc]->chip_type,"i82527"))
-		obj=15;
-	if (!strcmp(chips_p[cc]->chip_type,"sja1000"))
-		obj=1;
+	max_objects=chips_p[chip_nr]->max_objects;
 
-	for (i=0; i<obj; i++) {
-		oc=i;
-		base->channel[cc]->object[i] = (struct objectproc_t *)
-			kmalloc(sizeof(struct objectproc_t),GFP_KERNEL);
-				
-				
-		if (base->channel[cc]->object[i] == NULL)
-			return -ENOMEM;
-		else if (add_mem_to_list( base->channel[cc]->object[i]))
+	for (i=0; i<max_objects; i++) {
+		base->channel[chip_nr]->object[i] = (struct objectproc_t *)
+			can_checked_malloc(sizeof(struct objectproc_t));
+
+		if (base->channel[chip_nr]->object[i] == NULL)
 			return -ENOMEM;
 
-		sprintf(base->channel[cc]->object[i]->obj_name,"object%d",i);
-		sprintf(base->channel[cc]->object[i]->lnk_name,"dev");
-								
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
-		base->channel[cc]->object[i]->obj_entry=new_can_proc_entry(
-				0, base->channel[cc]->object[i]->obj_name,
-				S_IFDIR | S_IRUGO | S_IXUGO, 0, 
-				base->channel[cc]->ch_entry);
-		if (base->channel[cc]->object[i]->obj_entry == NULL)
-			return -ENODEV;
-		base->channel[cc]->object[i]->lnk = new_can_proc_entry(
-				0, base->channel[cc]->object[i]->lnk_name, 
-				S_IFLNK | S_IRUGO | S_IWUGO | S_IXUGO,
-				0, base->channel[cc]->object[i]->obj_entry);
-		if (base->channel[cc]->object[i]->lnk == NULL)
-			return -ENODEV;
-		sprintf(base->channel[cc]->object[i]->lnk_dev,"/dev/can");
-		base->channel[cc]->object[i]->lnk->readlink_proc =
-								candev_readlink;
+		sprintf(base->channel[chip_nr]->object[i]->obj_name,"object%d",i);
+		sprintf(base->channel[chip_nr]->object[i]->lnk_name,"dev");
 
-#else
-		base->channel[cc]->object[i]->obj_entry = create_proc_entry(
-				base->channel[cc]->object[i]->obj_name,
+		base->channel[chip_nr]->object[i]->obj_entry = can_create_proc_entry(
+				base->channel[chip_nr]->object[i]->obj_name,
 				S_IFDIR | S_IRUGO | S_IXUGO,
-				base->channel[cc]->ch_entry);
-		if (base->channel[cc]->object[i]->obj_entry == NULL)
+				base->channel[chip_nr]->ch_entry);
+		if (base->channel[chip_nr]->object[i]->obj_entry == NULL)
 			return -ENODEV;
-		sprintf(base->channel[cc]->object[i]->lnk_dev,"/dev/can%d",
-			chips_p[cc]->msgobj[i]->minor);
-		base->channel[cc]->object[i]->lnk = proc_symlink(
-				base->channel[cc]->object[i]->lnk_name,
-				base->channel[cc]->object[i]->obj_entry,
-				base->channel[cc]->object[i]->lnk_dev);
-		if (base->channel[cc]->object[i]->lnk == NULL)
+
+		sprintf(base->channel[chip_nr]->object[i]->lnk_dev,"/dev/can%d",
+			chips_p[chip_nr]->msgobj[i]->minor);
+
+		base->channel[chip_nr]->object[i]->lnk = can_proc_symlink(
+				base->channel[chip_nr]->object[i]->lnk_name,
+				base->channel[chip_nr]->object[i]->obj_entry,
+				base->channel[chip_nr]->object[i]->lnk_dev);
+		if (base->channel[chip_nr]->object[i]->lnk == NULL)
 			return -ENODEV;
-#endif
 
 	}
 	return 0;
-} 
+}
 
-int remove_object_from_procdir(void)
+int remove_object_from_procdir(int chip_nr)
 {
 	int i=0, obj=0;
 
-	if (!strcmp(chips_p[cc]->chip_type,"i82527"))
-		obj=15;
-	if (!strcmp(chips_p[cc]->chip_type,"sja1000"))
-		obj=1;
+	obj=chips_p[chip_nr]->max_objects;
 
 	for (i=0; i<obj; i++) {
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
-		if (can_remove_proc_entry( base->channel[cc]->object[i]->lnk,
-				base->channel[cc]->object[i]->obj_entry))	
+		if(!base->channel[chip_nr]->object[i]) continue;
+
+		/* name: base->channel[chip_nr]->object[i]->lnk_name */
+		if (can_remove_proc_entry( base->channel[chip_nr]->object[i]->lnk,
+				base->channel[chip_nr]->object[i]->obj_entry))
 			return -ENODEV;
+		/* name: base->channel[chip_nr]->object[i]->obj_name */
 		if (can_remove_proc_entry(
-				base->channel[cc]->object[i]->obj_entry,
-				base->channel[cc]->ch_entry))
+				base->channel[chip_nr]->object[i]->obj_entry,
+				base->channel[chip_nr]->ch_entry))
 			return -ENODEV;
-#else
-		remove_proc_entry(base->channel[cc]->object[i]->lnk_name,
-				base->channel[cc]->object[i]->obj_entry);
-		remove_proc_entry(base->channel[cc]->object[i]->obj_name,
-					base->channel[cc]->ch_entry);
-#endif
-		
+
+		can_checked_free(base->channel[chip_nr]->object[i]);
+
+		base->channel[chip_nr]->object[i]=NULL;
 	}
 	return 0;
 }
 
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,2,19))
-static int candev_readlink(struct proc_dir_entry *de, char *page)
-{
-	int i=0, nchip=0, nobj=0;
-	char chip[20], object[20], tmp[6];
-
-	sprintf(chip, de->parent->parent->name+7);
-	sprintf(object, de->parent->name+6);
-
-	for (i=0; i<MAX_TOT_CHIPS; i++) {
-		sprintf(tmp,"%d",i);
-		if (!strcmp(chip,tmp)) {
-			nchip=i;
-			break;
-		}	
-	}
-	for (i=0; i<MAX_MSGOBJS; i++) {
-		sprintf(tmp,"%d",i);
-		if (!strcmp(object,tmp)) {
-			nobj=i;
-			break;
-		}
-	}
-
-	return sprintf(page,"/dev/can%d",chips_p[nchip]->msgobj[nobj]->minor );
-}
-#endif //End of candev_readlink for kernel 2.2