devices.c revision fadb85e3bd333653014df5fcc931d844dc8c3630
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 100fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstruct platform_node { 101fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross char *name; 102fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross int name_len; 103fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode list; 104fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross}; 105fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 106bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandstatic list_declare(sys_perms); 10744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Crossstatic list_declare(dev_perms); 108fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstatic list_declare(platform_names); 1094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 110bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandint add_dev_perms(const char *name, const char *attr, 111bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland mode_t perm, unsigned int uid, unsigned int gid, 112bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland unsigned short prefix) { 113bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct perm_node *node = calloc(1, sizeof(*node)); 1144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (!node) 1154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -ENOMEM; 1164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 117bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland node->dp.name = strdup(name); 118bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (!node->dp.name) 1194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -ENOMEM; 1204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 121bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (attr) { 122bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland node->dp.attr = strdup(attr); 123bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (!node->dp.attr) 124bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland return -ENOMEM; 125bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland } 126bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 1274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.perm = perm; 1284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.uid = uid; 1294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.gid = gid; 1304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.prefix = prefix; 1314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 132bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (attr) 133bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_add_tail(&sys_perms, &node->plist); 134bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland else 135bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_add_tail(&dev_perms, &node->plist); 136bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 1374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return 0; 1384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 140bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandvoid fixup_sys_perms(const char *upath) 1414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 142bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland char buf[512]; 143bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct listnode *node; 144bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct perms_ *dp; 1454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 146bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland /* upaths omit the "/sys" that paths in this list 147bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland * contain, so we add 4 when comparing... 148bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland */ 149bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_for_each(node, &sys_perms) { 150bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland dp = &(node_to_item(node, struct perm_node, plist))->dp; 151bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (dp->prefix) { 152bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (strncmp(upath, dp->name + 4, strlen(dp->name + 4))) 1534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 1544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else { 155bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (strcmp(upath, dp->name + 4)) 1564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 1574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 158bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 159bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if ((strlen(upath) + strlen(dp->attr) + 6) > sizeof(buf)) 160bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland return; 161bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 162bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland sprintf(buf,"/sys%s/%s", upath, dp->attr); 163bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland INFO("fixup %s %d %d 0%o\n", buf, dp->uid, dp->gid, dp->perm); 164bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland chown(buf, dp->uid, dp->gid); 165bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland chmod(buf, dp->perm); 1664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 1674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 1694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic mode_t get_device_perm(const char *path, unsigned *uid, unsigned *gid) 1704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 1714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t perm; 17244b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct listnode *node; 17344b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct perm_node *perm_node; 17444b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct perms_ *dp; 17544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross 17644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross /* search the perms list in reverse so that ueventd.$hardware can 17744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross * override ueventd.rc 17844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross */ 17944b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross list_for_each_reverse(node, &dev_perms) { 18044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross perm_node = node_to_item(node, struct perm_node, plist); 18144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross dp = &perm_node->dp; 18244b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross 18344b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (dp->prefix) { 18444b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (strncmp(path, dp->name, strlen(dp->name))) 18544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross continue; 18644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross } else { 18744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (strcmp(path, dp->name)) 18844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross continue; 1894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 19044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *uid = dp->uid; 19144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *gid = dp->gid; 19244b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross return dp->perm; 1934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 19444b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross /* Default if nothing found. */ 19544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *uid = 0; 19644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *gid = 0; 19744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross return 0600; 1984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 200bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandstatic void make_device(const char *path, 201bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland const char *upath, 202bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland int block, int major, int minor) 2034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 2044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned uid; 2054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned gid; 2064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t mode; 2074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project dev_t dev; 2084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode = get_device_perm(path, &uid, &gid) | (block ? S_IFBLK : S_IFCHR); 21017dcc5c57dcffb919f3de65ff7a0134ffa3bd874Colin Cross dev = makedev(major, minor); 2116405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly /* Temporarily change egid to avoid race condition setting the gid of the 2126405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * device node. Unforunately changing the euid would prevent creation of 2136405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * some device nodes, so the uid has to be set with chown() and is still 2146405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * racy. Fixing the gid race at least fixed the issue with system_server 2156405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * opening dynamic input devices under the AID_INPUT gid. */ 2166405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly setegid(gid); 2174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mknod(path, mode, dev); 2186405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly chown(path, uid, -1); 2196405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly setegid(AID_ROOT); 2204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 2214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 222fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstatic void add_platform_device(const char *name) 223fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 224fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross int name_len = strlen(name); 225fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode *node; 226fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct platform_node *bus; 227fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 228fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_for_each_reverse(node, &platform_names) { 229fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = node_to_item(node, struct platform_node, list); 230fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross if ((bus->name_len < name_len) && 231fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross (name[bus->name_len] == '/') && 232fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross !strncmp(name, bus->name, bus->name_len)) 233fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross /* subdevice of an existing platform, ignore it */ 234fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross return; 235fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 236fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 237fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross INFO("adding platform device %s\n", name); 238fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 239fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = calloc(1, sizeof(struct platform_node)); 240fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus->name = strdup(name); 241fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus->name_len = name_len; 242fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_add_tail(&platform_names, &bus->list); 243fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 244fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 245fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross/* 246fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross * given a name that may start with a platform device, find the length of the 247fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross * platform device prefix. If it doesn't start with a platform device, return 248fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross * 0. 249fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross */ 250fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstatic const char *find_platform_device(const char *name) 251fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 252fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross int name_len = strlen(name); 253fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode *node; 254fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct platform_node *bus; 255fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 256fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_for_each_reverse(node, &platform_names) { 257fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = node_to_item(node, struct platform_node, list); 258fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross if ((bus->name_len < name_len) && 259fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross (name[bus->name_len] == '/') && 260fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross !strncmp(name, bus->name, bus->name_len)) 261fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross return bus->name; 262fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 263fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 264fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross return NULL; 265fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 266fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 267fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstatic void remove_platform_device(const char *name) 268fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 269fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode *node; 270fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct platform_node *bus; 271fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 272fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_for_each_reverse(node, &platform_names) { 273fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = node_to_item(node, struct platform_node, list); 274fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross if (!strcmp(name, bus->name)) { 275fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross INFO("removing platform device %s\n", name); 276fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross free(bus->name); 277fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_remove(node); 278fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross free(bus); 279fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross return; 280fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 281fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 282fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 283fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 2841e070846f8908dff15086efa12fbba01ab7eae15Chuck Tuffli#if LOG_UEVENTS 2854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic inline suseconds_t get_usecs(void) 2874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 2884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct timeval tv; 2894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project gettimeofday(&tv, 0); 2904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return tv.tv_sec * (suseconds_t) 1000000 + tv.tv_usec; 2914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 2924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(x...) INFO(x) 2944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#else 2964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(fmt, args...) do { } while (0) 2984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define get_usecs() 0 2994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#endif 3014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void parse_event(const char *msg, struct uevent *uevent) 3034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 3044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action = ""; 3054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->path = ""; 3064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->subsystem = ""; 3074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware = ""; 3084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->major = -1; 3094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->minor = -1; 310b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_name = NULL; 311b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_num = -1; 3124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* currently ignoring SEQNUM */ 3144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while(*msg) { 3154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!strncmp(msg, "ACTION=", 7)) { 3164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 7; 3174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action = msg; 3184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "DEVPATH=", 8)) { 3194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 8; 3204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->path = msg; 3214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "SUBSYSTEM=", 10)) { 3224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 10; 3234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->subsystem = msg; 3244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "FIRMWARE=", 9)) { 3254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 9; 3264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware = msg; 3274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "MAJOR=", 6)) { 3284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 6; 3294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->major = atoi(msg); 3304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "MINOR=", 6)) { 3314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 6; 3324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->minor = atoi(msg); 333b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } else if(!strncmp(msg, "PARTN=", 6)) { 334b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross msg += 6; 335b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_num = atoi(msg); 336b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } else if(!strncmp(msg, "PARTNAME=", 9)) { 337b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross msg += 9; 338b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_name = msg; 3394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 3404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* advance to after the next \0 */ 3424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while(*msg++) 3434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ; 3444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 3454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project log_event_print("event { '%s', '%s', '%s', '%s', %d, %d }\n", 3474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action, uevent->path, uevent->subsystem, 3484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware, uevent->major, uevent->minor); 3494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 3504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 351d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Gobystatic char **get_character_device_symlinks(struct uevent *uevent) 352d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby{ 353d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby const char *parent; 354d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby char *slash; 355d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby char **links; 356d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby int link_num = 0; 357d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby int width; 358d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 359d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (strncmp(uevent->path, "/devices/platform/", 18)) 360d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 361d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 362d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby links = malloc(sizeof(char *) * 2); 363d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!links) 364d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 365d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby memset(links, 0, sizeof(char *) * 2); 366d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 367d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby /* skip "/devices/platform/<driver>" */ 368d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby parent = strchr(uevent->path + 18, '/'); 369d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!*parent) 370d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 371d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 372d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!strncmp(parent, "/usb", 4)) { 373d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby /* skip root hub name and device. use device interface */ 374d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby while (*++parent && *parent != '/'); 375d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (*parent) 376d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby while (*++parent && *parent != '/'); 377d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!*parent) 378d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 379d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby slash = strchr(++parent, '/'); 380d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!slash) 381d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 382d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby width = slash - parent; 383d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (width <= 0) 384d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 385d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 386d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (asprintf(&links[link_num], "/dev/usb/%s%.*s", uevent->subsystem, width, parent) > 0) 387d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby link_num++; 388d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby else 389d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby links[link_num] = NULL; 390d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby mkdir("/dev/usb", 0755); 391d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby } 392d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby else { 393d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 394d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby } 395d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 396d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return links; 397d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Gobyerr: 398d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby free(links); 399d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 400d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby} 401d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 402b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Crossstatic char **parse_platform_block_device(struct uevent *uevent) 403b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross{ 404fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross const char *device; 405b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross const char *path; 406b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char *slash; 407b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int width; 408b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char buf[256]; 409b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char link_path[256]; 410b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int fd; 411b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int link_num = 0; 412b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int ret; 413b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char *p; 414b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross unsigned int size; 415b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross struct stat info; 416b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 417b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char **links = malloc(sizeof(char *) * 4); 418b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (!links) 419b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return NULL; 420b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross memset(links, 0, sizeof(char *) * 4); 421b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 422b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross /* Drop "/devices/platform/" */ 423b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross path = uevent->path; 424fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross device = path + 18; 425fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross device = find_platform_device(device); 426fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross if (!device) 427b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross goto err; 428b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 429fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross INFO("found platform device %s\n", device); 430fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 431fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross snprintf(link_path, sizeof(link_path), "/dev/block/platform/%s", device); 432b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 433b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (uevent->partition_name) { 434b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross p = strdup(uevent->partition_name); 435b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross sanitize(p); 436b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/by-name/%s", link_path, p) > 0) 437b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 438b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 439b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 440b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(p); 441b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 442b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 443b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (uevent->partition_num >= 0) { 444b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/by-num/p%d", link_path, uevent->partition_num) > 0) 445b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 446b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 447b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 448b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 449b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 450b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross slash = strrchr(path, '/'); 451b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/%s", link_path, slash + 1) > 0) 452b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 453b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 454b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 455b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 456b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return links; 457b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 458b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Crosserr: 459b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links); 460b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return NULL; 461b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross} 462b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 463eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_device(const char *action, const char *devpath, 464eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *path, int block, int major, int minor, char **links) 4654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 466b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int i; 4674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 468eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(!strcmp(action, "add")) { 469eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross make_device(devpath, path, block, major, minor); 470b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 471b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 472b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross make_link(devpath, links[i]); 473b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 4744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 4754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 476eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(!strcmp(action, "remove")) { 477b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 478b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 479b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross remove_link(devpath, links[i]); 480b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 4814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unlink(devpath); 482b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 483b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 484b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 485b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 486b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links[i]); 487b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links); 4884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 4894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 4904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 491fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstatic void handle_platform_device_event(struct uevent *uevent) 492fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 493fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross const char *name = uevent->path + 18; /* length of /devices/platform/ */ 494fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 495fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross if (!strcmp(uevent->action, "add")) 496fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross add_platform_device(name); 497fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross else if (!strcmp(uevent->action, "remove")) 498fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross remove_platform_device(name); 499fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 500fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 501eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic const char *parse_device_name(struct uevent *uevent, unsigned int len) 502eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 503eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *name; 504eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 505eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* if it's not a /dev device, nothing else to do */ 506eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if((uevent->major < 0) || (uevent->minor < 0)) 507eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return NULL; 508eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 509eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* do we have a name? */ 510eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name = strrchr(uevent->path, '/'); 511eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(!name) 512eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return NULL; 513eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name++; 514eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 515eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* too-long names would overrun our buffer */ 516eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(strlen(name) > len) 517eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return NULL; 518eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 519eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return name; 520eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 521eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 522eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_block_device_event(struct uevent *uevent) 523eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 524eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *base = "/dev/block/"; 525eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *name; 526eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char devpath[96]; 527eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char **links = NULL; 528eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 529eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name = parse_device_name(uevent, 64); 530eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!name) 531eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return; 532eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 533eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross snprintf(devpath, sizeof(devpath), "%s%s", base, name); 534eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 535eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 536eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strncmp(uevent->path, "/devices/platform/", 18)) 537eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross links = parse_platform_block_device(uevent); 538eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 539eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_device(uevent->action, devpath, uevent->path, 1, 540eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross uevent->major, uevent->minor, links); 541eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 542eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 543eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_generic_device_event(struct uevent *uevent) 544eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 545eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char *base; 546eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *name; 547eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char devpath[96] = {0}; 548eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char **links = NULL; 549eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 550eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name = parse_device_name(uevent, 64); 551eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!name) 552eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return; 553eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 554eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strncmp(uevent->subsystem, "usb", 3)) { 555eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strcmp(uevent->subsystem, "usb")) { 556eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* This imitates the file system that would be created 557eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross * if we were using devfs instead. 558eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross * Minors are broken up into groups of 128, starting at "001" 559eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross */ 560eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross int bus_id = uevent->minor / 128 + 1; 561eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross int device_id = uevent->minor % 128 + 1; 562eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* build directories */ 563eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir("/dev/bus", 0755); 564eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir("/dev/bus/usb", 0755); 565eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d", bus_id); 566eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(devpath, 0755); 567eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d/%03d", bus_id, device_id); 568eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else { 569eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* ignore other USB events */ 570eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return; 571eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } 572eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "graphics", 8)) { 573eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/graphics/"; 574eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 575eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "oncrpc", 6)) { 576eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/oncrpc/"; 577eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 578eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "adsp", 4)) { 579eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/adsp/"; 580eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 581eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "msm_camera", 10)) { 582eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/msm_camera/"; 583eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 584eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "input", 5)) { 585eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/input/"; 586eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 587eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "mtd", 3)) { 588eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/mtd/"; 589eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 590eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "sound", 5)) { 591eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/snd/"; 592eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 593eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "misc", 4) && 594eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross !strncmp(name, "log_", 4)) { 595eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/log/"; 596eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross mkdir(base, 0755); 597eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name += 4; 598eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else 599eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/"; 600eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross links = get_character_device_symlinks(uevent); 601eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 602eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!devpath[0]) 603eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross snprintf(devpath, sizeof(devpath), "%s%s", base, name); 604eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 605eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_device(uevent->action, devpath, uevent->path, 0, 606eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross uevent->major, uevent->minor, links); 607eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 608eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 609eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_device_event(struct uevent *uevent) 610eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 611eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strcmp(uevent->action,"add")) 612eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross fixup_sys_perms(uevent->path); 613eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 614eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strncmp(uevent->subsystem, "block", 5)) { 615eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_block_device_event(uevent); 616fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } else if (!strncmp(uevent->subsystem, "platform", 8)) { 617fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross handle_platform_device_event(uevent); 618eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else { 619eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_generic_device_event(uevent); 620eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } 621eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 622eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 6234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int load_firmware(int fw_fd, int loading_fd, int data_fd) 6244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 6254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct stat st; 6264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project long len_to_copy; 6274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int ret = 0; 6284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fstat(fw_fd, &st) < 0) 6304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -1; 6314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project len_to_copy = st.st_size; 6324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "1", 1); /* start transfer */ 6344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while (len_to_copy > 0) { 6364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project char buf[PAGE_SIZE]; 6374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ssize_t nr; 6384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nr = read(fw_fd, buf, sizeof(buf)); 6404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!nr) 6414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project break; 6424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(nr < 0) { 6434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ret = -1; 6444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project break; 6454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project len_to_copy -= nr; 6484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while (nr > 0) { 6494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ssize_t nw = 0; 6504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nw = write(data_fd, buf + nw, nr); 6524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(nw <= 0) { 6534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ret = -1; 6544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto out; 6554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nr -= nw; 6574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectout: 6614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!ret) 6624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "0", 1); /* successful end of transfer */ 6634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else 6644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "-1", 2); /* abort transfer */ 6654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return ret; 6674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 6684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6698d48c8e45724c7103f0ace7885d339e49399908bBrian Swetlandstatic int is_booting(void) 6708d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland{ 6718d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland return access("/dev/.booting", F_OK) == 0; 6728d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland} 6738d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland 6744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void process_firmware_event(struct uevent *uevent) 6754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 67602863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland char *root, *loading, *data, *file1 = NULL, *file2 = NULL; 6774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int l, loading_fd, data_fd, fw_fd; 6788d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland int booting = is_booting(); 6794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6808d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland INFO("firmware: loading '%s' for '%s'\n", 6818d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland uevent->firmware, uevent->path); 6824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&root, SYSFS_PREFIX"%s/", uevent->path); 6844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 6854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 6864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&loading, "%sloading", root); 6884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 6894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto root_free_out; 6904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&data, "%sdata", root); 6924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 6934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto loading_free_out; 6944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 69502863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland l = asprintf(&file1, FIRMWARE_DIR1"/%s", uevent->firmware); 69602863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland if (l == -1) 69702863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland goto data_free_out; 69802863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland 69902863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland l = asprintf(&file2, FIRMWARE_DIR2"/%s", uevent->firmware); 7004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 7014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto data_free_out; 7024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project loading_fd = open(loading, O_WRONLY); 7044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(loading_fd < 0) 7054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto file_free_out; 7064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project data_fd = open(data, O_WRONLY); 7084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(data_fd < 0) 7094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto loading_close_out; 7104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7118d48c8e45724c7103f0ace7885d339e49399908bBrian Swetlandtry_loading_again: 71202863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland fw_fd = open(file1, O_RDONLY); 71302863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland if(fw_fd < 0) { 71402863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland fw_fd = open(file2, O_RDONLY); 715609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby if (fw_fd < 0) { 7168d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland if (booting) { 7178d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland /* If we're not fully booted, we may be missing 7188d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland * filesystems needed for firmware, wait and retry. 7198d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland */ 7208d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland usleep(100000); 7218d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland booting = is_booting(); 7228d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland goto try_loading_again; 7238d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland } 7248d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland INFO("firmware: could not open '%s' %d\n", uevent->firmware, errno); 725609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby write(loading_fd, "-1", 2); 72602863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland goto data_close_out; 727609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby } 72802863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland } 7294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!load_firmware(fw_fd, loading_fd, data_fd)) 7318d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland INFO("firmware: copy success { '%s', '%s' }\n", root, uevent->firmware); 7324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else 7338d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland INFO("firmware: copy failure { '%s', '%s' }\n", root, uevent->firmware); 7344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fw_fd); 7364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_close_out: 7374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(data_fd); 7384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_close_out: 7394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(loading_fd); 7404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectfile_free_out: 74102863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland free(file1); 74202863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland free(file2); 7434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_free_out: 7444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(data); 7454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_free_out: 7464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(loading); 7474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectroot_free_out: 7484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(root); 7494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 7504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void handle_firmware_event(struct uevent *uevent) 7524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 7534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project pid_t pid; 754982a815c10cc28707d81c46112fc45b1c10df3beColin Cross int ret; 7554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(strcmp(uevent->subsystem, "firmware")) 7574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 7584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(strcmp(uevent->action, "add")) 7604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 7614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* we fork, to avoid making large memory allocations in init proper */ 7634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project pid = fork(); 7644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (!pid) { 7654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project process_firmware_event(uevent); 7664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project exit(EXIT_SUCCESS); 7674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 7684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 7694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define UEVENT_MSG_LEN 1024 7710dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid handle_device_fd() 7724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 7735f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich for(;;) { 7745f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich char msg[UEVENT_MSG_LEN+2]; 7755f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich char cred_msg[CMSG_SPACE(sizeof(struct ucred))]; 7765f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct iovec iov = {msg, sizeof(msg)}; 7775f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct sockaddr_nl snl; 7785f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct msghdr hdr = {&snl, sizeof(snl), &iov, 1, cred_msg, sizeof(cred_msg), 0}; 7795f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich 780fad7204e9eac20a87afacd7547ed8202a39319f8Nick Kralevich ssize_t n = recvmsg(device_fd, &hdr, 0); 7815f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if (n <= 0) { 7825f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich break; 7835f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 7844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7855f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if ((snl.nl_groups != 1) || (snl.nl_pid != 0)) { 7865f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich /* ignoring non-kernel netlink multicast message */ 7875f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich continue; 7885f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 7895f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich 7905f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct cmsghdr * cmsg = CMSG_FIRSTHDR(&hdr); 7915f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if (cmsg == NULL || cmsg->cmsg_type != SCM_CREDENTIALS) { 7925f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich /* no sender credentials received, ignore message */ 7935f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich continue; 7945f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 7955f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich 7965f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct ucred * cred = (struct ucred *)CMSG_DATA(cmsg); 7975f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if (cred->uid != 0) { 7985f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich /* message from non-root user, ignore */ 7995f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich continue; 8005f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich } 8014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8025f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if(n >= UEVENT_MSG_LEN) /* overflow -- discard */ 8034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 8044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg[n] = '\0'; 8064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg[n+1] = '\0'; 8074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8085f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct uevent uevent; 8094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project parse_event(msg, &uevent); 8104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project handle_device_event(&uevent); 8124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project handle_firmware_event(&uevent); 8134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 8154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* Coldboot walks parts of the /sys tree and pokes the uevent files 8174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** to cause the kernel to regenerate device add events that happened 8184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** before init's device manager was started 8194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** 8204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** We drain any pending events from the netlink socket every time 8214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** we poke another uevent file to make sure we don't overrun the 8224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** socket's buffer. 8234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project*/ 8244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8250dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void do_coldboot(DIR *d) 8264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct dirent *de; 8284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int dfd, fd; 8294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project dfd = dirfd(d); 8314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project fd = openat(dfd, "uevent", O_WRONLY); 8334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fd >= 0) { 8344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(fd, "add\n", 4); 8354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fd); 8360dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross handle_device_fd(); 8374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while((de = readdir(d))) { 8404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project DIR *d2; 8414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(de->d_type != DT_DIR || de->d_name[0] == '.') 8434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 8444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project fd = openat(dfd, de->d_name, O_RDONLY | O_DIRECTORY); 8464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fd < 0) 8474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 8484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project d2 = fdopendir(fd); 8504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(d2 == 0) 8514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fd); 8524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else { 8530dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross do_coldboot(d2); 8544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project closedir(d2); 8554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 8584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8590dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void coldboot(const char *path) 8604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project DIR *d = opendir(path); 8624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(d) { 8630dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross do_coldboot(d); 8644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project closedir(d); 8654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 8674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8680dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid device_init(void) 8694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project suseconds_t t0, t1; 871f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross struct stat info; 872f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross int fd; 8734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8740dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross device_fd = open_uevent_socket(); 8750dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross if(device_fd < 0) 8760dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross return; 8774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8780dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross fcntl(device_fd, F_SETFD, FD_CLOEXEC); 8790dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross fcntl(device_fd, F_SETFL, O_NONBLOCK); 8804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 881f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross if (stat(coldboot_done, &info) < 0) { 882f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross t0 = get_usecs(); 883f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/class"); 884f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/block"); 885f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/devices"); 886f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross t1 = get_usecs(); 887f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross fd = open(coldboot_done, O_WRONLY|O_CREAT, 0000); 888f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross close(fd); 889f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross log_event_print("coldboot %ld uS\n", ((long) (t1 - t0))); 890f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross } else { 891f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross log_event_print("skipping coldboot, already done\n"); 892f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross } 8930dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross} 8944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8950dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossint get_device_fd() 8960dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross{ 8970dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross return device_fd; 8984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 899