2003-07-21 07:48:48 +04:00
/*
* udev - add . c
*
* Userspace devfs
*
* Copyright ( C ) 2003 Greg Kroah - Hartman < greg @ kroah . com >
*
*
* This program is free software ; you can redistribute it and / or modify it
* under the terms of the GNU General Public License as published by the
* Free Software Foundation version 2 of the License .
*
* This program 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 this program ; if not , write to the Free Software Foundation , Inc . ,
* 675 Mass Ave , Cambridge , MA 0213 9 , USA .
*
*/
# include <stdlib.h>
# include <string.h>
# include <stdio.h>
# include <fcntl.h>
# include <unistd.h>
# include <errno.h>
# include "udev.h"
# include "udev_version.h"
# include "namedev.h"
2003-08-06 10:57:23 +04:00
# include "udevdb.h"
2003-07-21 07:48:48 +04:00
# include "libsysfs/libsysfs.h"
/*
* Right now the major / minor of a device is stored in a file called
* " dev " in sysfs .
* The number is stored as :
* MMmm
* MM is the major
* mm is the minor
* The value is in hex .
* Yes , this will probably change when we go to a bigger major / minor
* range , and will have to be changed at that time .
*/
static int get_major_minor ( struct sysfs_class_device * class_dev , int * major , int * minor )
{
2003-08-05 08:20:19 +04:00
int retval = - ENODEV ;
2003-07-21 07:48:48 +04:00
char * dev ;
dev = sysfs_get_value_from_attributes ( class_dev - > directory - > attributes , " dev " ) ;
if ( dev = = NULL )
2003-08-05 08:20:19 +04:00
goto exit ;
2003-07-21 07:48:48 +04:00
dbg ( " dev = %s " , dev ) ;
2003-08-05 08:20:19 +04:00
if ( sscanf ( dev , " %u:%u " , major , minor ) ! = 2 )
goto exit ;
2003-07-21 07:48:48 +04:00
dbg ( " found major = %d, minor = %d " , * major , * minor ) ;
retval = 0 ;
2003-08-05 08:20:19 +04:00
exit :
2003-07-21 07:48:48 +04:00
return retval ;
}
/*
* We also want to add some permissions here , and possibly some symlinks
*/
static int create_node ( char * name , char type , int major , int minor , int mode )
{
char filename [ 255 ] ;
int retval = 0 ;
strncpy ( filename , UDEV_ROOT , sizeof ( filename ) ) ;
strncat ( filename , name , sizeof ( filename ) ) ;
2003-08-05 08:59:50 +04:00
switch ( type ) {
case ' b ' :
mode | = S_IFBLK ;
break ;
case ' c ' :
case ' u ' :
mode | = S_IFCHR ;
break ;
case ' p ' :
mode | = S_IFIFO ;
break ;
default :
dbg ( " unknown node type %c \n " , type ) ;
return - EINVAL ;
}
2003-08-05 08:39:33 +04:00
2003-10-16 10:51:11 +04:00
dbg ( " mknod(%s, %#o, %u, %u) " , filename , mode , major , minor ) ;
2003-08-05 08:39:33 +04:00
retval = mknod ( filename , mode , makedev ( major , minor ) ) ;
2003-08-05 08:59:50 +04:00
if ( retval )
dbg ( " mknod(%s, %#o, %u, %u) failed with error '%s' " ,
filename , mode , major , minor , strerror ( errno ) ) ;
2003-07-21 07:48:48 +04:00
return retval ;
}
2003-10-20 08:55:43 +04:00
static struct sysfs_class_device * get_class_dev ( char * device_name )
2003-07-21 07:48:48 +04:00
{
2003-08-05 09:13:35 +04:00
char sysfs_path [ SYSFS_PATH_MAX ] ;
2003-07-21 07:48:48 +04:00
char dev_path [ SYSFS_PATH_MAX ] ;
2003-08-05 09:13:35 +04:00
int retval ;
struct sysfs_class_device * class_dev = NULL ;
retval = sysfs_get_mnt_path ( sysfs_path , SYSFS_PATH_MAX ) ;
dbg ( " sysfs_path = %s " , sysfs_path ) ;
if ( retval ) {
dbg ( " sysfs_get_mnt_path failed " ) ;
goto exit ;
}
2003-07-21 07:48:48 +04:00
strcpy ( dev_path , sysfs_path ) ;
strcat ( dev_path , device_name ) ;
dbg ( " looking at %s " , dev_path ) ;
/* open up the sysfs class device for this thing... */
class_dev = sysfs_open_class_device ( dev_path ) ;
if ( class_dev = = NULL ) {
dbg ( " sysfs_open_class_device failed " ) ;
2003-08-05 09:13:35 +04:00
goto exit ;
2003-07-21 07:48:48 +04:00
}
dbg ( " class_dev->name = %s " , class_dev - > name ) ;
2003-08-05 09:13:35 +04:00
exit :
2003-07-21 07:48:48 +04:00
return class_dev ;
}
int udev_add_device ( char * device , char * subsystem )
{
struct sysfs_class_device * class_dev ;
struct device_attr attr ;
int major ;
int minor ;
char type ;
int retval = - EINVAL ;
/* for now, the block layer is the only place where block devices are */
if ( strcmp ( subsystem , " block " ) = = 0 )
type = ' b ' ;
else
type = ' c ' ;
2003-08-05 09:13:35 +04:00
/* sleep for a second or two to give the kernel a chance to
* create the dev file
*/
sleep ( 1 ) ;
2003-07-21 07:48:48 +04:00
class_dev = get_class_dev ( device ) ;
if ( class_dev = = NULL )
goto exit ;
retval = namedev_name_device ( class_dev , & attr ) ;
if ( retval )
return retval ;
retval = get_major_minor ( class_dev , & major , & minor ) ;
if ( retval ) {
2003-10-18 10:32:17 +04:00
dbg ( " get_major_minor failed " ) ;
2003-07-21 07:48:48 +04:00
goto exit ;
}
2003-10-18 10:32:17 +04:00
retval = udevdb_add_device ( device , class_dev , attr . name , type , major , minor , attr . mode ) ;
2003-07-21 07:48:48 +04:00
2003-08-06 10:57:23 +04:00
if ( retval ! = 0 )
2003-10-18 10:32:17 +04:00
dbg ( " udevdb_add_device failed, but we are going to try to create the node anyway. "
" But remove might not work properly for this device. " ) ;
sysfs_close_class_device ( class_dev ) ;
2003-08-06 10:57:23 +04:00
2003-07-21 07:48:48 +04:00
return create_node ( attr . name , type , major , minor , attr . mode ) ;
exit :
return retval ;
}