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> 32e46f9d510db9351682cf17c49115110870147335Stephen Smalley 33e46f9d510db9351682cf17c49115110870147335Stephen Smalley#include <selinux/selinux.h> 34e46f9d510db9351682cf17c49115110870147335Stephen Smalley#include <selinux/label.h> 35ae6f3d7c05070f7e0e56fe0056c8923c6ee2f473Stephen Smalley#include <selinux/android.h> 36e46f9d510db9351682cf17c49115110870147335Stephen Smalley 374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <private/android_filesystem_config.h> 384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/time.h> 394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <asm/page.h> 40982a815c10cc28707d81c46112fc45b1c10df3beColin Cross#include <sys/wait.h> 414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 42da04c52ab1036048520fca265cf02b61dca789e0Dima Zavin#include <cutils/list.h> 433f582e92f07d358f3d0941b86407b39e2e7e67ccVernon Tang#include <cutils/uevent.h> 443f582e92f07d358f3d0941b86407b39e2e7e67ccVernon Tang 454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include "devices.h" 46b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross#include "util.h" 47ed8a7d84428ec945c48b6b53dc5a3a18fabaf683Colin Cross#include "log.h" 484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define SYSFS_PREFIX "/sys" 5002863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland#define FIRMWARE_DIR1 "/etc/firmware" 5102863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland#define FIRMWARE_DIR2 "/vendor/firmware" 52029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev#define FIRMWARE_DIR3 "/firmware/image" 534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 54e096e36e50b4b66638ebc4d3c09c2ee35f538dfaStephen Smalleyextern struct selabel_handle *sehandle; 55e46f9d510db9351682cf17c49115110870147335Stephen Smalley 560dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic int device_fd = -1; 570dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross 584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct uevent { 594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *action; 604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *path; 614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *subsystem; 624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project const char *firmware; 63b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross const char *partition_name; 64f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong const char *device_name; 65b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int partition_num; 664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int major; 674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int minor; 684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}; 694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct perms_ { 714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project char *name; 72bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland char *attr; 734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t perm; 744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned int uid; 754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned int gid; 764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned short prefix; 774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}; 784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct perm_node { 804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct perms_ dp; 814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct listnode plist; 824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}; 83bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 84fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstruct platform_node { 85fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross char *name; 86f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin char *path; 87f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin int path_len; 88fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode list; 89fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross}; 90fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 91bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandstatic list_declare(sys_perms); 9244b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Crossstatic list_declare(dev_perms); 93fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstatic list_declare(platform_names); 944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 95bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandint add_dev_perms(const char *name, const char *attr, 96bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland mode_t perm, unsigned int uid, unsigned int gid, 97bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland unsigned short prefix) { 98bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct perm_node *node = calloc(1, sizeof(*node)); 994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (!node) 1004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -ENOMEM; 1014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 102bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland node->dp.name = strdup(name); 103bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (!node->dp.name) 1044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -ENOMEM; 1054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 106bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (attr) { 107bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland node->dp.attr = strdup(attr); 108bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (!node->dp.attr) 109bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland return -ENOMEM; 110bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland } 111bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 1124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.perm = perm; 1134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.uid = uid; 1144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.gid = gid; 1154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project node->dp.prefix = prefix; 1164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 117bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (attr) 118bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_add_tail(&sys_perms, &node->plist); 119bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland else 120bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_add_tail(&dev_perms, &node->plist); 121bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 1224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return 0; 1234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 125bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandvoid fixup_sys_perms(const char *upath) 1264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 127bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland char buf[512]; 128bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct listnode *node; 129bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland struct perms_ *dp; 1305f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley char *secontext; 1314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 132bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland /* upaths omit the "/sys" that paths in this list 133bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland * contain, so we add 4 when comparing... 134bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland */ 135bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland list_for_each(node, &sys_perms) { 136bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland dp = &(node_to_item(node, struct perm_node, plist))->dp; 137bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (dp->prefix) { 138bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (strncmp(upath, dp->name + 4, strlen(dp->name + 4))) 1394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 1404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else { 141bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if (strcmp(upath, dp->name + 4)) 1424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 1434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 144bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 145bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland if ((strlen(upath) + strlen(dp->attr) + 6) > sizeof(buf)) 146bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland return; 147bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland 148bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland sprintf(buf,"/sys%s/%s", upath, dp->attr); 149bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland INFO("fixup %s %d %d 0%o\n", buf, dp->uid, dp->gid, dp->perm); 150bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland chown(buf, dp->uid, dp->gid); 151bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland chmod(buf, dp->perm); 1525f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley if (sehandle) { 1535f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley secontext = NULL; 1545f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley selabel_lookup(sehandle, &secontext, buf, 0); 1555f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley if (secontext) { 1565f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley setfilecon(buf, secontext); 1575f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley freecon(secontext); 1585f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley } 1595f7b017f41b5bd0b86b5078b17c41ef7bc201c8dStephen Smalley } 1604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 1614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 1634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic mode_t get_device_perm(const char *path, unsigned *uid, unsigned *gid) 1644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 1654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t perm; 16644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct listnode *node; 16744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct perm_node *perm_node; 16844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross struct perms_ *dp; 16944b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross 17044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross /* search the perms list in reverse so that ueventd.$hardware can 17144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross * override ueventd.rc 17244b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross */ 17344b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross list_for_each_reverse(node, &dev_perms) { 17444b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross perm_node = node_to_item(node, struct perm_node, plist); 17544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross dp = &perm_node->dp; 17644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross 17744b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (dp->prefix) { 17844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (strncmp(path, dp->name, strlen(dp->name))) 17944b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross continue; 18044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross } else { 18144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross if (strcmp(path, dp->name)) 18244b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross continue; 1834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 18444b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *uid = dp->uid; 18544b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *gid = dp->gid; 18644b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross return dp->perm; 1874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 18844b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross /* Default if nothing found. */ 18944b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *uid = 0; 19044b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross *gid = 0; 19144b65d047cc39baf30e21bfd8dd438f6bc1f77f5Colin Cross return 0600; 1924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 1934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 194bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetlandstatic void make_device(const char *path, 195bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland const char *upath, 196bc57d4ce925a62f14c28c55e0ff28af1114f12beBrian Swetland int block, int major, int minor) 1974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 1984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned uid; 1994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unsigned gid; 2004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode_t mode; 2014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project dev_t dev; 202e46f9d510db9351682cf17c49115110870147335Stephen Smalley char *secontext = NULL; 2034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 2044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mode = get_device_perm(path, &uid, &gid) | (block ? S_IFBLK : S_IFCHR); 205b5982bf7c65b30be981ecfe1847437b05e32b2bbKenny Root 206e46f9d510db9351682cf17c49115110870147335Stephen Smalley if (sehandle) { 207e46f9d510db9351682cf17c49115110870147335Stephen Smalley selabel_lookup(sehandle, &secontext, path, mode); 208e46f9d510db9351682cf17c49115110870147335Stephen Smalley setfscreatecon(secontext); 209e46f9d510db9351682cf17c49115110870147335Stephen Smalley } 210b5982bf7c65b30be981ecfe1847437b05e32b2bbKenny Root 21117dcc5c57dcffb919f3de65ff7a0134ffa3bd874Colin Cross dev = makedev(major, minor); 2126405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly /* Temporarily change egid to avoid race condition setting the gid of the 2136405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * device node. Unforunately changing the euid would prevent creation of 2146405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * some device nodes, so the uid has to be set with chown() and is still 2156405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * racy. Fixing the gid race at least fixed the issue with system_server 2166405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly * opening dynamic input devices under the AID_INPUT gid. */ 2176405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly setegid(gid); 2184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project mknod(path, mode, dev); 2196405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly chown(path, uid, -1); 2206405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly setegid(AID_ROOT); 221b5982bf7c65b30be981ecfe1847437b05e32b2bbKenny Root 222e46f9d510db9351682cf17c49115110870147335Stephen Smalley if (secontext) { 223e46f9d510db9351682cf17c49115110870147335Stephen Smalley freecon(secontext); 224e46f9d510db9351682cf17c49115110870147335Stephen Smalley setfscreatecon(NULL); 225e46f9d510db9351682cf17c49115110870147335Stephen Smalley } 226e46f9d510db9351682cf17c49115110870147335Stephen Smalley} 227e46f9d510db9351682cf17c49115110870147335Stephen Smalley 228f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavinstatic void add_platform_device(const char *path) 229fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 230f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin int path_len = strlen(path); 231fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode *node; 232fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct platform_node *bus; 233f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin const char *name = path; 234f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin 235f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if (!strncmp(path, "/devices/", 9)) { 236f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin name += 9; 237f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if (!strncmp(name, "platform/", 9)) 238f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin name += 9; 239f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin } 240fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 241fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_for_each_reverse(node, &platform_names) { 242fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = node_to_item(node, struct platform_node, list); 243f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if ((bus->path_len < path_len) && 244f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin (path[bus->path_len] == '/') && 245f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin !strncmp(path, bus->path, bus->path_len)) 246fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross /* subdevice of an existing platform, ignore it */ 247fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross return; 248fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 249fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 250f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin INFO("adding platform device %s (%s)\n", name, path); 251fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 252fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = calloc(1, sizeof(struct platform_node)); 253f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin bus->path = strdup(path); 254f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin bus->path_len = path_len; 255f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin bus->name = bus->path + (name - path); 256fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_add_tail(&platform_names, &bus->list); 257fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 258fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 259fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross/* 260f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin * given a path that may start with a platform device, find the length of the 261fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross * platform device prefix. If it doesn't start with a platform device, return 262fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross * 0. 263fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross */ 264f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavinstatic struct platform_node *find_platform_device(const char *path) 265fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 266f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin int path_len = strlen(path); 267fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode *node; 268fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct platform_node *bus; 269fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 270fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_for_each_reverse(node, &platform_names) { 271fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = node_to_item(node, struct platform_node, list); 272f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if ((bus->path_len < path_len) && 273f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin (path[bus->path_len] == '/') && 274f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin !strncmp(path, bus->path, bus->path_len)) 275f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin return bus; 276fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 277fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 278fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross return NULL; 279fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 280fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 281f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavinstatic void remove_platform_device(const char *path) 282fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 283fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct listnode *node; 284fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross struct platform_node *bus; 285fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 286fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_for_each_reverse(node, &platform_names) { 287fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross bus = node_to_item(node, struct platform_node, list); 288f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if (!strcmp(path, bus->path)) { 289f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin INFO("removing platform device %s\n", bus->name); 290f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin free(bus->path); 291fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross list_remove(node); 292fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross free(bus); 293fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross return; 294fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 295fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } 296fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 297fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 2981e070846f8908dff15086efa12fbba01ab7eae15Chuck Tuffli#if LOG_UEVENTS 2994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic inline suseconds_t get_usecs(void) 3014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 3024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct timeval tv; 3034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project gettimeofday(&tv, 0); 3044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return tv.tv_sec * (suseconds_t) 1000000 + tv.tv_usec; 3054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 3064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(x...) INFO(x) 3084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#else 3104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(fmt, args...) do { } while (0) 3124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define get_usecs() 0 3134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#endif 3154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void parse_event(const char *msg, struct uevent *uevent) 3174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 3184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action = ""; 3194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->path = ""; 3204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->subsystem = ""; 3214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware = ""; 3224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->major = -1; 3234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->minor = -1; 324b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_name = NULL; 325b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_num = -1; 326f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong uevent->device_name = NULL; 3274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* currently ignoring SEQNUM */ 3294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while(*msg) { 3304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!strncmp(msg, "ACTION=", 7)) { 3314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 7; 3324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action = msg; 3334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "DEVPATH=", 8)) { 3344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 8; 3354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->path = msg; 3364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "SUBSYSTEM=", 10)) { 3374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 10; 3384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->subsystem = msg; 3394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "FIRMWARE=", 9)) { 3404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 9; 3414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware = msg; 3424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "MAJOR=", 6)) { 3434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 6; 3444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->major = atoi(msg); 3454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } else if(!strncmp(msg, "MINOR=", 6)) { 3464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg += 6; 3474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->minor = atoi(msg); 348b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } else if(!strncmp(msg, "PARTN=", 6)) { 349b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross msg += 6; 350b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_num = atoi(msg); 351b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } else if(!strncmp(msg, "PARTNAME=", 9)) { 352b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross msg += 9; 353b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross uevent->partition_name = msg; 354f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong } else if(!strncmp(msg, "DEVNAME=", 8)) { 355f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong msg += 8; 356f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong uevent->device_name = msg; 3574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 3584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 359f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong /* advance to after the next \0 */ 3604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while(*msg++) 3614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ; 3624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 3634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 3644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project log_event_print("event { '%s', '%s', '%s', '%s', %d, %d }\n", 3654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->action, uevent->path, uevent->subsystem, 3664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project uevent->firmware, uevent->major, uevent->minor); 3674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 3684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 369d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Gobystatic char **get_character_device_symlinks(struct uevent *uevent) 370d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby{ 371d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby const char *parent; 372d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby char *slash; 373d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby char **links; 374d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby int link_num = 0; 375d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby int width; 376f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin struct platform_node *pdev; 377d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 378f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin pdev = find_platform_device(uevent->path); 379f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if (!pdev) 380d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 381d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 382d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby links = malloc(sizeof(char *) * 2); 383d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!links) 384d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 385d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby memset(links, 0, sizeof(char *) * 2); 386d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 387d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby /* skip "/devices/platform/<driver>" */ 388f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin parent = strchr(uevent->path + pdev->path_len, '/'); 389d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!*parent) 390d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 391d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 392d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!strncmp(parent, "/usb", 4)) { 393d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby /* skip root hub name and device. use device interface */ 394d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby while (*++parent && *parent != '/'); 395d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (*parent) 396d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby while (*++parent && *parent != '/'); 397d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!*parent) 398d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 399d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby slash = strchr(++parent, '/'); 400d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (!slash) 401d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 402d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby width = slash - parent; 403d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (width <= 0) 404d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 405d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 406d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby if (asprintf(&links[link_num], "/dev/usb/%s%.*s", uevent->subsystem, width, parent) > 0) 407d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby link_num++; 408d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby else 409d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby links[link_num] = NULL; 410d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby mkdir("/dev/usb", 0755); 411d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby } 412d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby else { 413d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby goto err; 414d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby } 415d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 416d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return links; 417d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Gobyerr: 418d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby free(links); 419d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby return NULL; 420d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby} 421d2278638d6b37717b51d622929eb4c8f6e16cb0cBenoit Goby 422b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Crossstatic char **parse_platform_block_device(struct uevent *uevent) 423b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross{ 424fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross const char *device; 425f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin struct platform_node *pdev; 426b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char *slash; 427b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int width; 428b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char buf[256]; 429b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char link_path[256]; 430b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int fd; 431b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int link_num = 0; 432b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int ret; 433b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char *p; 434b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross unsigned int size; 435b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross struct stat info; 436b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 437f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin pdev = find_platform_device(uevent->path); 438f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if (!pdev) 439f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin return NULL; 440f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin device = pdev->name; 441f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin 442b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross char **links = malloc(sizeof(char *) * 4); 443b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (!links) 444b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return NULL; 445b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross memset(links, 0, sizeof(char *) * 4); 446b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 447fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross INFO("found platform device %s\n", device); 448fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 449fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross snprintf(link_path, sizeof(link_path), "/dev/block/platform/%s", device); 450b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 451b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (uevent->partition_name) { 452b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross p = strdup(uevent->partition_name); 453b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross sanitize(p); 45493ca79b44535ee24ece08001e1948070db6ab6edJohan Redestig if (strcmp(uevent->partition_name, p)) 45593ca79b44535ee24ece08001e1948070db6ab6edJohan Redestig NOTICE("Linking partition '%s' as '%s'\n", uevent->partition_name, p); 456b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/by-name/%s", link_path, p) > 0) 457b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 458b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 459b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 460b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(p); 461b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 462b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 463b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (uevent->partition_num >= 0) { 464b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/by-num/p%d", link_path, uevent->partition_num) > 0) 465b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 466b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 467b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 468b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 469b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 470f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin slash = strrchr(uevent->path, '/'); 471b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (asprintf(&links[link_num], "%s/%s", link_path, slash + 1) > 0) 472b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross link_num++; 473b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross else 474b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross links[link_num] = NULL; 475b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 476b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross return links; 477b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross} 478b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 479eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_device(const char *action, const char *devpath, 480eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *path, int block, int major, int minor, char **links) 4814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 482b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross int i; 4834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 484eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(!strcmp(action, "add")) { 485eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross make_device(devpath, path, block, major, minor); 486b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 487b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 488b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross make_link(devpath, links[i]); 489b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 4904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 4914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 492eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(!strcmp(action, "remove")) { 493b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 494b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 495b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross remove_link(devpath, links[i]); 496b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 4974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project unlink(devpath); 498b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross } 499b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross 500b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross if (links) { 501b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross for (i = 0; links[i]; i++) 502b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links[i]); 503b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross free(links); 5044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 5054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 5064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 507fadb85e3bd333653014df5fcc931d844dc8c3630Colin Crossstatic void handle_platform_device_event(struct uevent *uevent) 508fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross{ 509f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin const char *path = uevent->path; 510fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 511fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross if (!strcmp(uevent->action, "add")) 512f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin add_platform_device(path); 513fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross else if (!strcmp(uevent->action, "remove")) 514f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin remove_platform_device(path); 515fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross} 516fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross 517eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic const char *parse_device_name(struct uevent *uevent, unsigned int len) 518eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 519eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *name; 520eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 521eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* if it's not a /dev device, nothing else to do */ 522eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if((uevent->major < 0) || (uevent->minor < 0)) 523eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return NULL; 524eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 525eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* do we have a name? */ 526eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name = strrchr(uevent->path, '/'); 527eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(!name) 528eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return NULL; 529eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name++; 530eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 531eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* too-long names would overrun our buffer */ 532eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if(strlen(name) > len) 533eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return NULL; 534eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 535eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return name; 536eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 537eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 538eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_block_device_event(struct uevent *uevent) 539eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 540eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *base = "/dev/block/"; 541eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *name; 542eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char devpath[96]; 543eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char **links = NULL; 544eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 545eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name = parse_device_name(uevent, 64); 546eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!name) 547eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return; 548eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 549eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross snprintf(devpath, sizeof(devpath), "%s%s", base, name); 550e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 551eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 552f395c9237da69f1cc15f26a2525a82a371d5816dDima Zavin if (!strncmp(uevent->path, "/devices/", 9)) 553eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross links = parse_platform_block_device(uevent); 554eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 555eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_device(uevent->action, devpath, uevent->path, 1, 556eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross uevent->major, uevent->minor, links); 557eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 558eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 559eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_generic_device_event(struct uevent *uevent) 560eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 561eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char *base; 562eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross const char *name; 563eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char devpath[96] = {0}; 564eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross char **links = NULL; 565eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 566eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name = parse_device_name(uevent, 64); 567eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!name) 568eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return; 569eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 570eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strncmp(uevent->subsystem, "usb", 3)) { 571eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strcmp(uevent->subsystem, "usb")) { 572f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong if (uevent->device_name) { 573f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong /* 574f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong * create device node provided by kernel if present 575f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong * see drivers/base/core.c 576f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong */ 577f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong char *p = devpath; 578f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong snprintf(devpath, sizeof(devpath), "/dev/%s", uevent->device_name); 579f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong /* skip leading /dev/ */ 580f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong p += 5; 581f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong /* build directories */ 582f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong while (*p) { 583f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong if (*p == '/') { 584f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong *p = 0; 585f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong make_dir(devpath, 0755); 586f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong *p = '/'; 587f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong } 588f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong p++; 589f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong } 590f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong } 591f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong else { 592f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong /* This imitates the file system that would be created 593f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong * if we were using devfs instead. 594f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong * Minors are broken up into groups of 128, starting at "001" 595f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong */ 596f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong int bus_id = uevent->minor / 128 + 1; 597f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong int device_id = uevent->minor % 128 + 1; 598f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong /* build directories */ 599f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong make_dir("/dev/bus", 0755); 600f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong make_dir("/dev/bus/usb", 0755); 601f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d", bus_id); 602f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong make_dir(devpath, 0755); 603f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d/%03d", bus_id, device_id); 604f97b887848cc64e7d88d27f198b7721c9f2f8ec8Wei Zhong } 605eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else { 606eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross /* ignore other USB events */ 607eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross return; 608eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } 609eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "graphics", 8)) { 610eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/graphics/"; 611e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 612e6f8d45da8c61d67dc9fdc1cec53f40594043817Lukasz Anaczkowski } else if (!strncmp(uevent->subsystem, "drm", 3)) { 613e6f8d45da8c61d67dc9fdc1cec53f40594043817Lukasz Anaczkowski base = "/dev/dri/"; 614e6f8d45da8c61d67dc9fdc1cec53f40594043817Lukasz Anaczkowski make_dir(base, 0755); 615eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "oncrpc", 6)) { 616eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/oncrpc/"; 617e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 618eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "adsp", 4)) { 619eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/adsp/"; 620e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 621eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if (!strncmp(uevent->subsystem, "msm_camera", 10)) { 622eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/msm_camera/"; 623e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 624eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "input", 5)) { 625eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/input/"; 626e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 627eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "mtd", 3)) { 628eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/mtd/"; 629e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 630eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "sound", 5)) { 631eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/snd/"; 632e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 633eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else if(!strncmp(uevent->subsystem, "misc", 4) && 634eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross !strncmp(name, "log_", 4)) { 635eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/log/"; 636e46f9d510db9351682cf17c49115110870147335Stephen Smalley make_dir(base, 0755); 637eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross name += 4; 638eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else 639eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross base = "/dev/"; 640eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross links = get_character_device_symlinks(uevent); 641eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 642eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!devpath[0]) 643eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross snprintf(devpath, sizeof(devpath), "%s%s", base, name); 644eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 645eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_device(uevent->action, devpath, uevent->path, 0, 646eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross uevent->major, uevent->minor, links); 647eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 648eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 649eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Crossstatic void handle_device_event(struct uevent *uevent) 650eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross{ 651308bc52d33afa1b7b470e14fa8478045456cbb20Colin Cross if (!strcmp(uevent->action,"add") || !strcmp(uevent->action, "change")) 652eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross fixup_sys_perms(uevent->path); 653eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 654eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross if (!strncmp(uevent->subsystem, "block", 5)) { 655eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_block_device_event(uevent); 656fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross } else if (!strncmp(uevent->subsystem, "platform", 8)) { 657fadb85e3bd333653014df5fcc931d844dc8c3630Colin Cross handle_platform_device_event(uevent); 658eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } else { 659eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross handle_generic_device_event(uevent); 660eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross } 661eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross} 662eb5ba8306522acdbf3a63ca847e5e6b990d842b9Colin Cross 6634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int load_firmware(int fw_fd, int loading_fd, int data_fd) 6644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 6654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct stat st; 6664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project long len_to_copy; 6674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int ret = 0; 6684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fstat(fw_fd, &st) < 0) 6704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return -1; 6714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project len_to_copy = st.st_size; 6724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "1", 1); /* start transfer */ 6744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while (len_to_copy > 0) { 6764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project char buf[PAGE_SIZE]; 6774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ssize_t nr; 6784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nr = read(fw_fd, buf, sizeof(buf)); 6804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!nr) 6814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project break; 6824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(nr < 0) { 6834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ret = -1; 6844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project break; 6854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project len_to_copy -= nr; 6884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while (nr > 0) { 6894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ssize_t nw = 0; 6904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 6914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nw = write(data_fd, buf + nw, nr); 6924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(nw <= 0) { 6934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project ret = -1; 6944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto out; 6954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project nr -= nw; 6974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 6994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectout: 7014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!ret) 7024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "0", 1); /* successful end of transfer */ 7034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else 7044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(loading_fd, "-1", 2); /* abort transfer */ 7054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return ret; 7074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 7084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7098d48c8e45724c7103f0ace7885d339e49399908bBrian Swetlandstatic int is_booting(void) 7108d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland{ 7118d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland return access("/dev/.booting", F_OK) == 0; 7128d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland} 7138d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland 7144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void process_firmware_event(struct uevent *uevent) 7154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 716029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev char *root, *loading, *data, *file1 = NULL, *file2 = NULL, *file3 = NULL; 7174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int l, loading_fd, data_fd, fw_fd; 7188d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland int booting = is_booting(); 7194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7208d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland INFO("firmware: loading '%s' for '%s'\n", 7218d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland uevent->firmware, uevent->path); 7224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&root, SYSFS_PREFIX"%s/", uevent->path); 7244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 7254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 7264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&loading, "%sloading", root); 7284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 7294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto root_free_out; 7304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project l = asprintf(&data, "%sdata", root); 7324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 7334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto loading_free_out; 7344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 73502863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland l = asprintf(&file1, FIRMWARE_DIR1"/%s", uevent->firmware); 73602863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland if (l == -1) 73702863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland goto data_free_out; 73802863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland 73902863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland l = asprintf(&file2, FIRMWARE_DIR2"/%s", uevent->firmware); 7404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (l == -1) 7414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto data_free_out; 7424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 743029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev l = asprintf(&file3, FIRMWARE_DIR3"/%s", uevent->firmware); 744029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev if (l == -1) 745029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev goto data_free_out; 746029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev 7474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project loading_fd = open(loading, O_WRONLY); 7484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(loading_fd < 0) 7494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto file_free_out; 7504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project data_fd = open(data, O_WRONLY); 7524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(data_fd < 0) 7534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project goto loading_close_out; 7544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7558d48c8e45724c7103f0ace7885d339e49399908bBrian Swetlandtry_loading_again: 75602863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland fw_fd = open(file1, O_RDONLY); 75702863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland if(fw_fd < 0) { 75802863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland fw_fd = open(file2, O_RDONLY); 759609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby if (fw_fd < 0) { 760029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev fw_fd = open(file3, O_RDONLY); 761029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev if (fw_fd < 0) { 762029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev if (booting) { 763029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev /* If we're not fully booted, we may be missing 764029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev * filesystems needed for firmware, wait and retry. 765029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev */ 766029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev usleep(100000); 767029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev booting = is_booting(); 768029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev goto try_loading_again; 769029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev } 770029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev INFO("firmware: could not open '%s' %d\n", uevent->firmware, errno); 771029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev write(loading_fd, "-1", 2); 772029d44e6aef334d2f0f03cbc9a5609cddc1b23e3Iliyan Malchev goto data_close_out; 7738d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland } 774609d8828d3b8266a80606bf902d1294296962cf3Benoit Goby } 77502863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland } 7764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(!load_firmware(fw_fd, loading_fd, data_fd)) 7788d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland INFO("firmware: copy success { '%s', '%s' }\n", root, uevent->firmware); 7794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else 7808d48c8e45724c7103f0ace7885d339e49399908bBrian Swetland INFO("firmware: copy failure { '%s', '%s' }\n", root, uevent->firmware); 7814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fw_fd); 7834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_close_out: 7844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(data_fd); 7854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_close_out: 7864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(loading_fd); 7874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectfile_free_out: 78802863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland free(file1); 78902863b957cfbfc302d3136ed78c0cba86accacd8Brian Swetland free(file2); 79076c5889325c2ada5dda07fd9af20a4a485978538Ajay Dudani free(file3); 7914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_free_out: 7924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(data); 7934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_free_out: 7944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(loading); 7954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectroot_free_out: 7964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project free(root); 7974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 7984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 7994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void handle_firmware_event(struct uevent *uevent) 8004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project pid_t pid; 802982a815c10cc28707d81c46112fc45b1c10df3beColin Cross int ret; 8034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(strcmp(uevent->subsystem, "firmware")) 8054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 8064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(strcmp(uevent->action, "add")) 8084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project return; 8094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project /* we fork, to avoid making large memory allocations in init proper */ 8114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project pid = fork(); 8124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if (!pid) { 8134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project process_firmware_event(uevent); 8144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project exit(EXIT_SUCCESS); 8154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 8174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define UEVENT_MSG_LEN 1024 8190dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid handle_device_fd() 8204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8213f582e92f07d358f3d0941b86407b39e2e7e67ccVernon Tang char msg[UEVENT_MSG_LEN+2]; 8223f582e92f07d358f3d0941b86407b39e2e7e67ccVernon Tang int n; 82357de8b8f27f887ca8084671df777a4ac199ba647Nick Kralevich while ((n = uevent_kernel_multicast_recv(device_fd, msg, UEVENT_MSG_LEN)) > 0) { 8245f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich if(n >= UEVENT_MSG_LEN) /* overflow -- discard */ 8254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 8264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg[n] = '\0'; 8284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project msg[n+1] = '\0'; 8294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8305f5d5c8cef10f28950fa108a8bd86d55f11b7ef4Nick Kralevich struct uevent uevent; 8314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project parse_event(msg, &uevent); 8324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project handle_device_event(&uevent); 8344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project handle_firmware_event(&uevent); 8354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 8374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* Coldboot walks parts of the /sys tree and pokes the uevent files 8394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** to cause the kernel to regenerate device add events that happened 8404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** before init's device manager was started 8414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** 8424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** We drain any pending events from the netlink socket every time 8434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** we poke another uevent file to make sure we don't overrun the 8444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** socket's buffer. 8454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project*/ 8464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8470dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void do_coldboot(DIR *d) 8484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project struct dirent *de; 8504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project int dfd, fd; 8514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project dfd = dirfd(d); 8534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project fd = openat(dfd, "uevent", O_WRONLY); 8554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fd >= 0) { 8564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project write(fd, "add\n", 4); 8574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fd); 8580dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross handle_device_fd(); 8594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project while((de = readdir(d))) { 8624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project DIR *d2; 8634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(de->d_type != DT_DIR || de->d_name[0] == '.') 8654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 8664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project fd = openat(dfd, de->d_name, O_RDONLY | O_DIRECTORY); 8684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(fd < 0) 8694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project continue; 8704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project d2 = fdopendir(fd); 8724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(d2 == 0) 8734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project close(fd); 8744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project else { 8750dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross do_coldboot(d2); 8764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project closedir(d2); 8774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 8804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8810dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void coldboot(const char *path) 8824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project DIR *d = opendir(path); 8844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project if(d) { 8850dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross do_coldboot(d); 8864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project closedir(d); 8874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project } 8884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 8894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 8900dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid device_init(void) 8914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{ 8924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project suseconds_t t0, t1; 893f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross struct stat info; 894f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross int fd; 895b5982bf7c65b30be981ecfe1847437b05e32b2bbKenny Root 896ae6f3d7c05070f7e0e56fe0056c8923c6ee2f473Stephen Smalley sehandle = NULL; 897ae6f3d7c05070f7e0e56fe0056c8923c6ee2f473Stephen Smalley if (is_selinux_enabled() > 0) { 898ae6f3d7c05070f7e0e56fe0056c8923c6ee2f473Stephen Smalley sehandle = selinux_android_file_context_handle(); 899ae6f3d7c05070f7e0e56fe0056c8923c6ee2f473Stephen Smalley } 900b5982bf7c65b30be981ecfe1847437b05e32b2bbKenny Root 901d562ca78aa713d186e83f05061c0aed88e200bcdAndrew Boie /* is 256K enough? udev uses 16MB! */ 902d562ca78aa713d186e83f05061c0aed88e200bcdAndrew Boie device_fd = uevent_open_socket(256*1024, true); 9030dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross if(device_fd < 0) 9040dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross return; 9054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 9060dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross fcntl(device_fd, F_SETFD, FD_CLOEXEC); 9070dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross fcntl(device_fd, F_SETFL, O_NONBLOCK); 9084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 909f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross if (stat(coldboot_done, &info) < 0) { 910f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross t0 = get_usecs(); 911f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/class"); 912f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/block"); 913f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross coldboot("/sys/devices"); 914f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross t1 = get_usecs(); 915f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross fd = open(coldboot_done, O_WRONLY|O_CREAT, 0000); 916f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross close(fd); 917f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross log_event_print("coldboot %ld uS\n", ((long) (t1 - t0))); 918f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross } else { 919f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross log_event_print("skipping coldboot, already done\n"); 920f83d0b9af5cbe4440cc41ceaa8a7806a13c86282Colin Cross } 9210dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross} 9224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project 9230dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossint get_device_fd() 9240dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross{ 9250dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross return device_fd; 9264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project} 927