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>
2003-10-23 06:39:54 +04:00
# include <sys/stat.h>
2003-07-21 07:48:48 +04:00
# 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 :
2003-10-21 07:31:24 +04:00
* MM : mm
2003-07-21 07:48:48 +04:00
* MM is the major
* mm is the minor
2003-10-21 07:31:24 +04:00
* The value is in decimal .
2003-07-21 07:48:48 +04:00
*/
2003-11-14 07:08:10 +03:00
static int get_major_minor ( struct sysfs_class_device * class_dev , struct udevice * udev )
2003-07-21 07:48:48 +04:00
{
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-11-14 07:08:10 +03:00
if ( sscanf ( dev , " %u:%u " , & udev - > major , & udev - > minor ) ! = 2 )
2003-08-05 08:20:19 +04:00
goto exit ;
2003-07-21 07:48:48 +04:00
2003-11-14 07:08:10 +03:00
dbg ( " found major = %d, minor = %d " , udev - > major , udev - > minor ) ;
2003-07-21 07:48:48 +04:00
retval = 0 ;
2003-08-05 08:20:19 +04:00
exit :
2003-07-21 07:48:48 +04:00
return retval ;
}
/*
2003-11-12 14:47:57 +03:00
* we possibly want to add some symlinks here
* only numeric owner / group id ' s are supported
2003-07-21 07:48:48 +04:00
*/
2003-10-21 09:48:44 +04:00
static int create_node ( struct udevice * dev )
2003-07-21 07:48:48 +04:00
{
char filename [ 255 ] ;
int retval = 0 ;
2003-11-12 14:50:33 +03:00
uid_t uid = 0 ;
gid_t gid = 0 ;
2003-10-23 10:48:55 +04:00
dev_t res ;
2003-10-21 09:48:44 +04:00
2003-10-22 07:19:09 +04:00
strncpy ( filename , udev_root , sizeof ( filename ) ) ;
2003-10-21 09:48:44 +04:00
strncat ( filename , dev - > name , sizeof ( filename ) ) ;
2003-10-23 10:48:55 +04:00
# ifdef __KLIBC__
res = ( dev - > major < < 8 ) | ( dev - > minor ) ;
# else
res = makedev ( dev - > major , dev - > minor ) ;
# endif
2003-10-21 09:48:44 +04:00
switch ( dev - > type ) {
2003-08-05 08:59:50 +04:00
case ' b ' :
2003-10-21 09:48:44 +04:00
dev - > mode | = S_IFBLK ;
2003-08-05 08:59:50 +04:00
break ;
case ' c ' :
case ' u ' :
2003-10-21 09:48:44 +04:00
dev - > mode | = S_IFCHR ;
2003-08-05 08:59:50 +04:00
break ;
case ' p ' :
2003-10-21 09:48:44 +04:00
dev - > mode | = S_IFIFO ;
2003-08-05 08:59:50 +04:00
break ;
default :
2003-10-21 09:48:44 +04:00
dbg ( " unknown node type %c \n " , dev - > type ) ;
2003-08-05 08:59:50 +04:00
return - EINVAL ;
}
2003-08-05 08:39:33 +04:00
2003-11-12 14:48:01 +03:00
/* create subdirectories if requested */
if ( strchr ( dev - > name , ' / ' ) ) {
char path [ 255 ] ;
char * pos ;
struct stat stats ;
strncpy ( path , filename , sizeof ( path ) ) ;
pos = strchr ( path + 1 , ' / ' ) ;
while ( 1 ) {
pos = strchr ( pos + 1 , ' / ' ) ;
if ( pos = = NULL )
break ;
* pos = 0x00 ;
if ( stat ( path , & stats ) ) {
retval = mkdir ( path , 0755 ) ;
if ( retval ) {
dbg ( " mkdir(%s) failed with error '%s' " ,
path , strerror ( errno ) ) ;
return retval ;
}
dbg ( " created %s " , path ) ;
}
* pos = ' / ' ;
}
}
2003-10-21 09:48:44 +04:00
dbg ( " mknod(%s, %#o, %u, %u) " , filename , dev - > mode , dev - > major , dev - > minor ) ;
2003-10-23 10:48:55 +04:00
retval = mknod ( filename , dev - > mode , res ) ;
2003-08-05 08:59:50 +04:00
if ( retval )
dbg ( " mknod(%s, %#o, %u, %u) failed with error '%s' " ,
2003-10-21 09:48:44 +04:00
filename , dev - > mode , dev - > major , dev - > minor , strerror ( errno ) ) ;
2003-11-19 20:23:24 +03:00
dbg ( " chmod(%s, %#o) " , filename , dev - > mode ) ;
retval = chmod ( filename , dev - > mode ) ;
if ( retval )
dbg ( " chmod(%s, %#o) failed with error '%s' " ,
filename , dev - > mode , strerror ( errno ) ) ;
2003-11-12 14:47:57 +03:00
if ( * dev - > owner ) {
char * endptr ;
unsigned long id = strtoul ( dev - > owner , & endptr , 10 ) ;
if ( * endptr = = 0x00 )
uid = ( uid_t ) id ;
else
dbg ( " only numeric owner id supported: %s " , dev - > owner ) ;
}
if ( * dev - > group ) {
char * endptr ;
unsigned long id = strtoul ( dev - > group , & endptr , 10 ) ;
if ( * endptr = = 0x00 )
gid = ( gid_t ) id ;
else
dbg ( " only numeric group id supported: %s " , dev - > group ) ;
}
if ( uid | | gid ) {
dbg ( " chown(%s, %u, %u) " , filename , uid , gid ) ;
retval = chown ( filename , uid , gid ) ;
if ( retval )
dbg ( " chown(%s, %u, %u) failed with error '%s' " , filename ,
uid , gid , 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
{
char dev_path [ SYSFS_PATH_MAX ] ;
2003-08-05 09:13:35 +04:00
struct sysfs_class_device * class_dev = NULL ;
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 ;
}
2003-10-21 08:03:15 +04:00
/* wait for the "dev" file to show up in the directory in sysfs.
* If it doesn ' t happen in about 10 seconds , give up .
*/
# define SECONDS_TO_WAIT_FOR_DEV 10
2003-10-22 08:45:19 +04:00
static int sleep_for_dev ( char * path )
2003-10-21 08:03:15 +04:00
{
char filename [ SYSFS_PATH_MAX + 6 ] ;
2003-10-23 11:50:27 +04:00
int loop = SECONDS_TO_WAIT_FOR_DEV ;
int retval ;
2003-10-21 08:03:15 +04:00
strcpy ( filename , sysfs_path ) ;
2003-10-21 09:48:44 +04:00
strcat ( filename , path ) ;
2003-10-21 08:03:15 +04:00
strcat ( filename , " /dev " ) ;
2003-10-23 11:50:27 +04:00
while ( loop - - ) {
struct stat buf ;
2003-10-21 08:03:15 +04:00
dbg ( " looking for %s " , filename ) ;
retval = stat ( filename , & buf ) ;
2003-10-23 11:50:27 +04:00
if ( ! retval )
2003-10-21 08:03:15 +04:00
goto exit ;
/* sleep for a second or two to give the kernel a chance to
* create the dev file */
sleep ( 1 ) ;
}
retval = - ENODEV ;
exit :
return retval ;
}
2003-10-21 09:48:44 +04:00
int udev_add_device ( char * path , char * subsystem )
2003-07-21 07:48:48 +04:00
{
2003-11-14 07:08:10 +03:00
struct sysfs_class_device * class_dev = NULL ;
2003-10-21 09:48:44 +04:00
struct udevice dev ;
2003-07-21 07:48:48 +04:00
int retval = - EINVAL ;
/* for now, the block layer is the only place where block devices are */
if ( strcmp ( subsystem , " block " ) = = 0 )
2003-10-21 09:48:44 +04:00
dev . type = ' b ' ;
2003-07-21 07:48:48 +04:00
else
2003-10-21 09:48:44 +04:00
dev . type = ' c ' ;
2003-07-21 07:48:48 +04:00
2003-10-21 09:48:44 +04:00
retval = sleep_for_dev ( path ) ;
2003-10-21 08:03:15 +04:00
if ( retval )
goto exit ;
2003-08-05 09:13:35 +04:00
2003-10-21 09:48:44 +04:00
class_dev = get_class_dev ( path ) ;
2003-07-21 07:48:48 +04:00
if ( class_dev = = NULL )
goto exit ;
2003-11-14 07:08:10 +03:00
retval = get_major_minor ( class_dev , & dev ) ;
2003-07-21 07:48:48 +04:00
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-11-14 07:08:10 +03:00
retval = namedev_name_device ( class_dev , & dev ) ;
if ( retval )
goto exit ;
2003-10-21 09:48:44 +04:00
retval = udevdb_add_dev ( path , & dev ) ;
2003-08-06 10:57:23 +04:00
if ( retval ! = 0 )
2003-10-21 09:48:44 +04:00
dbg ( " udevdb_add_dev failed, but we are going to try to create the node anyway. "
2003-10-18 10:32:17 +04:00
" But remove might not work properly for this device. " ) ;
2003-10-21 09:48:44 +04:00
dbg ( " name = %s " , dev . name ) ;
retval = create_node ( & dev ) ;
2003-07-21 07:48:48 +04:00
exit :
2003-11-14 07:08:10 +03:00
if ( class_dev )
sysfs_close_class_device ( class_dev ) ;
2003-07-21 07:48:48 +04:00
return retval ;
}