devices.c revision b93e5812faffd3b6c5fb349072413aace31918d8
14f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* 24f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * Copyright (C) 2007 The Android Open Source Project 34f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * 44f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * Licensed under the Apache License, Version 2.0 (the "License"); 54f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * you may not use this file except in compliance with the License. 64f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * You may obtain a copy of the License at 74f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * 84f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * http://www.apache.org/licenses/LICENSE-2.0 94f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * 104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * Unless required by applicable law or agreed to in writing, software 114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * distributed under the License is distributed on an "AS IS" BASIS, 124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * See the License for the specific language governing permissions and 144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * limitations under the License. 154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project */ 164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <errno.h> 18b93e5812faffd3b6c5fb349072413aace31918d8Olivier Bailly#include <stddef.h> 194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <stdio.h> 204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <stdlib.h> 214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/stat.h> 224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/types.h> 234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <fcntl.h> 254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <dirent.h> 264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <unistd.h> 274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <string.h> 284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/socket.h> 304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/un.h> 314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <linux/netlink.h> 324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <private/android_filesystem_config.h> 334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/time.h> 344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <asm/page.h> 35982a815c10cc28707d81c46112fc45b1c10df3beColin Cross#include <sys/wait.h> 364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include "devices.h" 38b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross#include "util.h" 39ed8a7d84428ec945c48b6b53dc5a3a18fabaf683Colin Cross#include "log.h" 40ed8a7d84428ec945c48b6b53dc5a3a18fabaf683Colin Cross#include "list.h" 414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define SYSFS_PREFIX "/sys" 4302863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland#define FIRMWARE_DIR1 "/etc/firmware" 4402863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland#define FIRMWARE_DIR2 "/vendor/firmware" 454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 460dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic int device_fd = -1; 470dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross 484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct uevent { 494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *action; 504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *path; 514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *subsystem; 524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *firmware; 53b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross const char *partition_name; 54b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int partition_num; 554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int major; 564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int minor; 574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}; 584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int open_uevent_socket(void) 604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct sockaddr_nl addr; 624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int sz = 64*1024; // XXX larger? udev uses 16MB! 635f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich int on = 1; 644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int s; 654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project memset(&addr, 0, sizeof(addr)); 674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project addr.nl_family = AF_NETLINK; 684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project addr.nl_pid = getpid(); 694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project addr.nl_groups = 0xffffffff; 704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project s = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_KOBJECT_UEVENT); 724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(s < 0) 734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -1; 744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project setsockopt(s, SOL_SOCKET, SO_RCVBUFFORCE, &sz, sizeof(sz)); 765f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich setsockopt(s, SOL_SOCKET, SO_PASSCRED, &on, sizeof(on)); 774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(bind(s, (struct sockaddr *) &addr, sizeof(addr)) < 0) { 794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(s); 804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -1; 814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return s; 844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct perms_ { 874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project char *name; 88bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland char *attr; 894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t perm; 904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned int uid; 914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned int gid; 924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned short prefix; 934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}; 944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct perm_node { 964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct perms_ dp; 974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct listnode plist; 984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}; 99bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 100bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandstatic list_declare(sys_perms); 10144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Crossstatic list_declare(dev_perms); 1024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 103bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandint add_dev_perms(const char *name, const char *attr, 104bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland mode_t perm, unsigned int uid, unsigned int gid, 105bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland unsigned short prefix) { 106bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct perm_node *node = calloc(1, sizeof(*node)); 1074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (!node) 1084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -ENOMEM; 1094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 110bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland node->dp.name = strdup(name); 111bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (!node->dp.name) 1124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -ENOMEM; 1134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 114bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (attr) { 115bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland node->dp.attr = strdup(attr); 116bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (!node->dp.attr) 117bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland return -ENOMEM; 118bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland } 119bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 1204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.perm = perm; 1214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.uid = uid; 1224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.gid = gid; 1234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.prefix = prefix; 1244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 125bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (attr) 126bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_add_tail(&sys_perms, &node->plist); 127bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland else 128bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_add_tail(&dev_perms, &node->plist); 129bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 1304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return 0; 1314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 133bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandvoid fixup_sys_perms(const char *upath) 1344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 135bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland char buf[512]; 136bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct listnode *node; 137bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct perms_ *dp; 1384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 139bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland /* upaths omit the "/sys" that paths in this list 140bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland * contain, so we add 4 when comparing... 141bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland */ 142bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_for_each(node, &sys_perms) { 143bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland dp = &(node_to_item(node, struct perm_node, plist))->dp; 144bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (dp->prefix) { 145bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (strncmp(upath, dp->name + 4, strlen(dp->name + 4))) 1464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 1474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else { 148bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (strcmp(upath, dp->name + 4)) 1494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 1504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 151bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 152bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if ((strlen(upath) + strlen(dp->attr) + 6) > sizeof(buf)) 153bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland return; 154bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 155bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland sprintf(buf,"/sys%s/%s", upath, dp->attr); 156bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland INFO("fixup %s %d %d 0%o\n", buf, dp->uid, dp->gid, dp->perm); 157bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland chown(buf, dp->uid, dp->gid); 158bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland chmod(buf, dp->perm); 1594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 1604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 1624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic mode_t get_device_perm(const char *path, unsigned *uid, unsigned *gid) 1634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 1644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t perm; 16544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct listnode *node; 16644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct perm_node *perm_node; 16744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct perms_ *dp; 16844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross 16944b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross /* search the perms list in reverse so that ueventd.$hardware can 17044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross * override ueventd.rc 17144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross */ 17244b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross list_for_each_reverse(node, &dev_perms) { 17344b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross perm_node = node_to_item(node, struct perm_node, plist); 17444b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross dp = &perm_node->dp; 17544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross 17644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (dp->prefix) { 17744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (strncmp(path, dp->name, strlen(dp->name))) 17844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross continue; 17944b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross } else { 18044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (strcmp(path, dp->name)) 18144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross continue; 1824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 18344b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *uid = dp->uid; 18444b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *gid = dp->gid; 18544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross return dp->perm; 1864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 18744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross /* Default if nothing found. */ 18844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *uid = 0; 18944b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *gid = 0; 19044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross return 0600; 1914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 193bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandstatic void make_device(const char *path, 194bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland const char *upath, 195bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland int block, int major, int minor) 1964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 1974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned uid; 1984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned gid; 1994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t mode; 2004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project dev_t dev; 2014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode = get_device_perm(path, &uid, &gid) | (block ? S_IFBLK : S_IFCHR); 20317dcc5c57dcffb919f3de65ff7a0134ffa3bd874Colin Cross dev = makedev(major, minor); 2046405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly /* Temporarily change egid to avoid race condition setting the gid of the 2056405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * device node. Unforunately changing the euid would prevent creation of 2066405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * some device nodes, so the uid has to be set with chown() and is still 2076405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * racy. Fixing the gid race at least fixed the issue with system_server 2086405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * opening dynamic input devices under the AID_INPUT gid. */ 2096405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly setegid(gid); 2104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mknod(path, mode, dev); 2116405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly chown(path, uid, -1); 2126405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly setegid(AID_ROOT); 2134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 2144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2151e070846f8908dff15086efa12fbba01ab7eae15Chuck Tuffli#if LOG_UEVENTS 2164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic inline suseconds_t get_usecs(void) 2184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 2194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct timeval tv; 2204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project gettimeofday(&tv, 0); 2214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return tv.tv_sec * (suseconds_t) 1000000 + tv.tv_usec; 2224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 2234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(x...) INFO(x) 2254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#else 2274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(fmt, args...) do { } while (0) 2294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define get_usecs() 0 2304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#endif 2324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void parse_event(const char *msg, struct uevent *uevent) 2344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 2354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action = ""; 2364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->path = ""; 2374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->subsystem = ""; 2384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware = ""; 2394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->major = -1; 2404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->minor = -1; 241b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_name = NULL; 242b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_num = -1; 2434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* currently ignoring SEQNUM */ 2454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while(*msg) { 2464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!strncmp(msg, "ACTION=", 7)) { 2474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 7; 2484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action = msg; 2494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "DEVPATH=", 8)) { 2504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 8; 2514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->path = msg; 2524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "SUBSYSTEM=", 10)) { 2534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 10; 2544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->subsystem = msg; 2554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "FIRMWARE=", 9)) { 2564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 9; 2574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware = msg; 2584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "MAJOR=", 6)) { 2594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 6; 2604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->major = atoi(msg); 2614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "MINOR=", 6)) { 2624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 6; 2634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->minor = atoi(msg); 264b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } else if(!strncmp(msg, "PARTN=", 6)) { 265b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross msg += 6; 266b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_num = atoi(msg); 267b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } else if(!strncmp(msg, "PARTNAME=", 9)) { 268b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross msg += 9; 269b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_name = msg; 2704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 2714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* advance to after the next \0 */ 2734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while(*msg++) 2744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ; 2754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 2764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project log_event_print("event { '%s', '%s', '%s', '%s', %d, %d }\n", 2784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action, uevent->path, uevent->subsystem, 2794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware, uevent->major, uevent->minor); 2804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 2814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 282d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Gobystatic char **get_character_device_symlinks(struct uevent *uevent) 283d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby{ 284d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby const char *parent; 285d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby char *slash; 286d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby char **links; 287d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby int link_num = 0; 288d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby int width; 289d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 290d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (strncmp(uevent->path, "/devices/platform/", 18)) 291d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 292d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 293d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby links = malloc(sizeof(char *) * 2); 294d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!links) 295d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 296d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby memset(links, 0, sizeof(char *) * 2); 297d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 298d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby /* skip "/devices/platform/<driver>" */ 299d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby parent = strchr(uevent->path + 18, '/'); 300d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!*parent) 301d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 302d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 303d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!strncmp(parent, "/usb", 4)) { 304d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby /* skip root hub name and device. use device interface */ 305d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby while (*++parent && *parent != '/'); 306d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (*parent) 307d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby while (*++parent && *parent != '/'); 308d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!*parent) 309d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 310d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby slash = strchr(++parent, '/'); 311d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!slash) 312d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 313d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby width = slash - parent; 314d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (width <= 0) 315d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 316d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 317d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (asprintf(&links[link_num], "/dev/usb/%s%.*s", uevent->subsystem, width, parent) > 0) 318d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby link_num++; 319d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby else 320d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby links[link_num] = NULL; 321d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby mkdir("/dev/usb", 0755); 322d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby } 323d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby else { 324d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 325d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby } 326d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 327d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return links; 328d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Gobyerr: 329d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby free(links); 330d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 331d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby} 332d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 333b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Crossstatic char **parse_platform_block_device(struct uevent *uevent) 334b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross{ 335b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross const char *driver; 336b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross const char *path; 337b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char *slash; 338b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int width; 339b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char buf[256]; 340b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char link_path[256]; 341b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int fd; 342b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int link_num = 0; 343b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int ret; 344b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char *p; 345b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross unsigned int size; 346b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross struct stat info; 347b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 348b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char **links = malloc(sizeof(char *) * 4); 349b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (!links) 350b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return NULL; 351b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross memset(links, 0, sizeof(char *) * 4); 352b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 353b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross /* Drop "/devices/platform/" */ 354b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross path = uevent->path; 355b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross driver = path + 18; 356b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross slash = strchr(driver, '/'); 357b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (!slash) 358b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross goto err; 359b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross width = slash - driver; 360b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (width <= 0) 361b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross goto err; 362b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 363b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross snprintf(link_path, sizeof(link_path), "/dev/block/platform/%.*s", 364b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross width, driver); 365b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 366b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (uevent->partition_name) { 367b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross p = strdup(uevent->partition_name); 368b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross sanitize(p); 369b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/by-name/%s", link_path, p) > 0) 370b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 371b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 372b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 373b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(p); 374b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 375b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 376b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (uevent->partition_num >= 0) { 377b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/by-num/p%d", link_path, uevent->partition_num) > 0) 378b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 379b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 380b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 381b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 382b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 383b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross slash = strrchr(path, '/'); 384b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/%s", link_path, slash + 1) > 0) 385b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 386b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 387b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 388b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 389b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return links; 390b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 391b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Crosserr: 392b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links); 393b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return NULL; 394b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross} 395b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 3964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void handle_device_event(struct uevent *uevent) 3974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 3984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project char devpath[96]; 39993ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood int devpath_ready = 0; 4004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project char *base, *name; 401b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char **links = NULL; 4024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int block; 403b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int i; 4044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 405bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (!strcmp(uevent->action,"add")) 406bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland fixup_sys_perms(uevent->path); 407bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 408bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland /* if it's not a /dev device, nothing else to do */ 4094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if((uevent->major < 0) || (uevent->minor < 0)) 4104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 4114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 4124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* do we have a name? */ 4134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project name = strrchr(uevent->path, '/'); 4144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!name) 4154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 4164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project name++; 4174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 4184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* too-long names would overrun our buffer */ 4194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(strlen(name) > 64) 4204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 4214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 4224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* are we block or char? where should we live? */ 42335237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project if(!strncmp(uevent->subsystem, "block", 5)) { 4244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project block = 1; 4254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/block/"; 4264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mkdir(base, 0755); 427b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (!strncmp(uevent->path, "/devices/platform/", 18)) 428b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links = parse_platform_block_device(uevent); 4294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else { 4304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project block = 0; 4314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* this should probably be configurable somehow */ 43293ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood if (!strncmp(uevent->subsystem, "usb", 3)) { 43393ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood if (!strcmp(uevent->subsystem, "usb")) { 43493ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood /* This imitates the file system that would be created 43593ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood * if we were using devfs instead. 43693ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood * Minors are broken up into groups of 128, starting at "001" 43793ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood */ 43893ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood int bus_id = uevent->minor / 128 + 1; 43993ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood int device_id = uevent->minor % 128 + 1; 44093ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood /* build directories */ 44193ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood mkdir("/dev/bus", 0755); 44293ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood mkdir("/dev/bus/usb", 0755); 44393ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d", bus_id); 44493ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood mkdir(devpath, 0755); 44593ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d/%03d", bus_id, device_id); 44693ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood devpath_ready = 1; 44793ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood } else { 44893ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood /* ignore other USB events */ 44993ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood return; 45093ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood } 45193ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood } else if (!strncmp(uevent->subsystem, "graphics", 8)) { 4524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/graphics/"; 4534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mkdir(base, 0755); 45435237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project } else if (!strncmp(uevent->subsystem, "oncrpc", 6)) { 4554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/oncrpc/"; 4564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mkdir(base, 0755); 45735237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project } else if (!strncmp(uevent->subsystem, "adsp", 4)) { 4584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/adsp/"; 4594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mkdir(base, 0755); 460fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev } else if (!strncmp(uevent->subsystem, "msm_camera", 10)) { 461fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev base = "/dev/msm_camera/"; 462fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev mkdir(base, 0755); 463fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev } else if(!strncmp(uevent->subsystem, "input", 5)) { 4644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/input/"; 4654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mkdir(base, 0755); 46635237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project } else if(!strncmp(uevent->subsystem, "mtd", 3)) { 4674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/mtd/"; 4684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mkdir(base, 0755); 4695bb44c8ea2bc513fefc526918980ab3d17494eccXiaopeng Yang } else if(!strncmp(uevent->subsystem, "sound", 5)) { 4705bb44c8ea2bc513fefc526918980ab3d17494eccXiaopeng Yang base = "/dev/snd/"; 4715bb44c8ea2bc513fefc526918980ab3d17494eccXiaopeng Yang mkdir(base, 0755); 47235237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project } else if(!strncmp(uevent->subsystem, "misc", 4) && 4734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project !strncmp(name, "log_", 4)) { 4744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/log/"; 4754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mkdir(base, 0755); 4764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project name += 4; 4774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else 4784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project base = "/dev/"; 479d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby links = get_character_device_symlinks(uevent); 4804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 4814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 48293ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood if (!devpath_ready) 48393ac1559b8c7ad3125ddcd896082b030faadbbd4Mike Lockwood snprintf(devpath, sizeof(devpath), "%s%s", base, name); 4844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 4854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!strcmp(uevent->action, "add")) { 486bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland make_device(devpath, uevent->path, block, uevent->major, uevent->minor); 487b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 488b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 489b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross make_link(devpath, links[i]); 490b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 4914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 4924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 4934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!strcmp(uevent->action, "remove")) { 494b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 495b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 496b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross remove_link(devpath, links[i]); 497b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 4984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unlink(devpath); 499b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 500b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 501b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 502b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 503b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links[i]); 504b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links); 5054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 5064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 5074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int load_firmware(int fw_fd, int loading_fd, int data_fd) 5094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 5104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct stat st; 5114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project long len_to_copy; 5124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int ret = 0; 5134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fstat(fw_fd, &st) < 0) 5154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -1; 5164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project len_to_copy = st.st_size; 5174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "1", 1); /* start transfer */ 5194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while (len_to_copy > 0) { 5214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project char buf[PAGE_SIZE]; 5224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ssize_t nr; 5234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nr = read(fw_fd, buf, sizeof(buf)); 5254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!nr) 5264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project break; 5274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(nr < 0) { 5284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ret = -1; 5294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project break; 5304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 5314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project len_to_copy -= nr; 5334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while (nr > 0) { 5344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ssize_t nw = 0; 5354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nw = write(data_fd, buf + nw, nr); 5374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(nw <= 0) { 5384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ret = -1; 5394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto out; 5404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 5414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nr -= nw; 5424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 5434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 5444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectout: 5464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!ret) 5474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "0", 1); /* successful end of transfer */ 5484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else 5494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "-1", 2); /* abort transfer */ 5504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return ret; 5524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 5534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void process_firmware_event(struct uevent *uevent) 5554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 55602863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland char *root, *loading, *data, *file1 = NULL, *file2 = NULL; 5574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int l, loading_fd, data_fd, fw_fd; 5584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project log_event_print("firmware event { '%s', '%s' }\n", 5604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->path, uevent->firmware); 5614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&root, SYSFS_PREFIX"%s/", uevent->path); 5634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 5644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 5654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&loading, "%sloading", root); 5674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 5684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto root_free_out; 5694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&data, "%sdata", root); 5714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 5724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto loading_free_out; 5734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 57402863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland l = asprintf(&file1, FIRMWARE_DIR1"/%s", uevent->firmware); 57502863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland if (l == -1) 57602863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland goto data_free_out; 57702863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland 57802863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland l = asprintf(&file2, FIRMWARE_DIR2"/%s", uevent->firmware); 5794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 5804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto data_free_out; 5814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project loading_fd = open(loading, O_WRONLY); 5834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(loading_fd < 0) 5844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto file_free_out; 5854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project data_fd = open(data, O_WRONLY); 5874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(data_fd < 0) 5884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto loading_close_out; 5894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 59002863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland fw_fd = open(file1, O_RDONLY); 59102863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland if(fw_fd < 0) { 59202863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland fw_fd = open(file2, O_RDONLY); 593609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby if (fw_fd < 0) { 594609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby write(loading_fd, "-1", 2); 59502863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland goto data_close_out; 596609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby } 59702863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland } 5984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 5994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!load_firmware(fw_fd, loading_fd, data_fd)) 60002863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland log_event_print("firmware copy success { '%s', '%s' }\n", root, uevent->firmware); 6014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else 60202863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland log_event_print("firmware copy failure { '%s', '%s' }\n", root, uevent->firmware); 6034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fw_fd); 6054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_close_out: 6064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(data_fd); 6074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_close_out: 6084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(loading_fd); 6094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectfile_free_out: 61002863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland free(file1); 61102863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland free(file2); 6124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_free_out: 6134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(data); 6144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_free_out: 6154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(loading); 6164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectroot_free_out: 6174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(root); 6184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 6194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void handle_firmware_event(struct uevent *uevent) 6214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 6224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project pid_t pid; 623982a815c10cc28707d81c46112fc45b1c10df3beColin Cross int status; 624982a815c10cc28707d81c46112fc45b1c10df3beColin Cross int ret; 6254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(strcmp(uevent->subsystem, "firmware")) 6274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 6284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(strcmp(uevent->action, "add")) 6304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 6314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* we fork, to avoid making large memory allocations in init proper */ 6334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project pid = fork(); 6344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (!pid) { 6354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project process_firmware_event(uevent); 6364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project exit(EXIT_SUCCESS); 637982a815c10cc28707d81c46112fc45b1c10df3beColin Cross } else { 638982a815c10cc28707d81c46112fc45b1c10df3beColin Cross do { 639982a815c10cc28707d81c46112fc45b1c10df3beColin Cross ret = waitpid(pid, &status, 0); 640982a815c10cc28707d81c46112fc45b1c10df3beColin Cross } while (ret == -1 && errno == EINTR); 6414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 6434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define UEVENT_MSG_LEN 1024 6450dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid handle_device_fd() 6464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 6475f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich for(;;) { 6485f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich char msg[UEVENT_MSG_LEN+2]; 6495f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich char cred_msg[CMSG_SPACE(sizeof(struct ucred))]; 6505f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct iovec iov = {msg, sizeof(msg)}; 6515f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct sockaddr_nl snl; 6525f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct msghdr hdr = {&snl, sizeof(snl), &iov, 1, cred_msg, sizeof(cred_msg), 0}; 6535f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich 654fad7204e9eac20a87afacd7547ed8202a39319f8Nick Kralevich ssize_t n = recvmsg(device_fd, &hdr, 0); 6555f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if (n <= 0) { 6565f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich break; 6575f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 6584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6595f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if ((snl.nl_groups != 1) || (snl.nl_pid != 0)) { 6605f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich /* ignoring non-kernel netlink multicast message */ 6615f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich continue; 6625f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 6635f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich 6645f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct cmsghdr * cmsg = CMSG_FIRSTHDR(&hdr); 6655f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if (cmsg == NULL || cmsg->cmsg_type != SCM_CREDENTIALS) { 6665f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich /* no sender credentials received, ignore message */ 6675f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich continue; 6685f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 6695f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich 6705f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct ucred * cred = (struct ucred *)CMSG_DATA(cmsg); 6715f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if (cred->uid != 0) { 6725f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich /* message from non-root user, ignore */ 6735f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich continue; 6745f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 6754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6765f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if(n >= UEVENT_MSG_LEN) /* overflow -- discard */ 6774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 6784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg[n] = '\0'; 6804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg[n+1] = '\0'; 6814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6825f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct uevent uevent; 6834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project parse_event(msg, &uevent); 6844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project handle_device_event(&uevent); 6864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project handle_firmware_event(&uevent); 6874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 6894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* Coldboot walks parts of the /sys tree and pokes the uevent files 6914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** to cause the kernel to regenerate device add events that happened 6924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** before init's device manager was started 6934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** 6944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** We drain any pending events from the netlink socket every time 6954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** we poke another uevent file to make sure we don't overrun the 6964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** socket's buffer. 6974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project*/ 6984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6990dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void do_coldboot(DIR *d) 7004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 7014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct dirent *de; 7024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int dfd, fd; 7034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project dfd = dirfd(d); 7054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project fd = openat(dfd, "uevent", O_WRONLY); 7074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fd >= 0) { 7084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(fd, "add\n", 4); 7094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fd); 7100dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross handle_device_fd(); 7114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 7124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while((de = readdir(d))) { 7144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project DIR *d2; 7154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(de->d_type != DT_DIR || de->d_name[0] == '.') 7174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 7184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project fd = openat(dfd, de->d_name, O_RDONLY | O_DIRECTORY); 7204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fd < 0) 7214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 7224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project d2 = fdopendir(fd); 7244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(d2 == 0) 7254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fd); 7264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else { 7270dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross do_coldboot(d2); 7284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project closedir(d2); 7294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 7304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 7314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 7324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7330dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void coldboot(const char *path) 7344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 7354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project DIR *d = opendir(path); 7364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(d) { 7370dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross do_coldboot(d); 7384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project closedir(d); 7394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 7404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 7414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7420dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid device_init(void) 7434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 7444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project suseconds_t t0, t1; 745f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross struct stat info; 746f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross int fd; 7474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7480dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross device_fd = open_uevent_socket(); 7490dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross if(device_fd < 0) 7500dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross return; 7514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7520dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross fcntl(device_fd, F_SETFD, FD_CLOEXEC); 7530dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross fcntl(device_fd, F_SETFL, O_NONBLOCK); 7544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 755f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross if (stat(coldboot_done, &info) < 0) { 756f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross t0 = get_usecs(); 757f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/class"); 758f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/block"); 759f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/devices"); 760f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross t1 = get_usecs(); 761f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross fd = open(coldboot_done, O_WRONLY|O_CREAT, 0000); 762f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross close(fd); 763f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross log_event_print("coldboot %ld uS\n", ((long) (t1 - t0))); 764f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross } else { 765f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross log_event_print("skipping coldboot, already done\n"); 766f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross } 7670dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross} 7684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7690dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossint get_device_fd() 7700dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross{ 7710dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross return device_fd; 7724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 773