devices.c revision b0ab94b7d5a888f0b6920b156e5c6a075fa0741a
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>
184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <stdio.h>
194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <stdlib.h>
204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/stat.h>
214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/types.h>
224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <fcntl.h>
244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <dirent.h>
254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <unistd.h>
264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <string.h>
274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/socket.h>
294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/un.h>
304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <linux/netlink.h>
314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <private/android_filesystem_config.h>
324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <sys/time.h>
334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include <asm/page.h>
344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include "init.h"
364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#include "devices.h"
37b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross#include "util.h"
384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define CMDLINE_PREFIX  "/dev"
404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define SYSFS_PREFIX    "/sys"
414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define FIRMWARE_DIR    "/etc/firmware"
424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define MAX_QEMU_PERM 6
434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
440dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic int device_fd = -1;
450dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross
464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct uevent {
474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    const char *action;
484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    const char *path;
494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    const char *subsystem;
504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    const char *firmware;
51b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    const char *partition_name;
52b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    int partition_num;
534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int major;
544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int minor;
554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project};
564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int open_uevent_socket(void)
584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    struct sockaddr_nl addr;
604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int sz = 64*1024; // XXX larger? udev uses 16MB!
614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int s;
624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    memset(&addr, 0, sizeof(addr));
644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    addr.nl_family = AF_NETLINK;
654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    addr.nl_pid = getpid();
664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    addr.nl_groups = 0xffffffff;
674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    s = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_KOBJECT_UEVENT);
694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(s < 0)
704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return -1;
714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    setsockopt(s, SOL_SOCKET, SO_RCVBUFFORCE, &sz, sizeof(sz));
734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(bind(s, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        close(s);
764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return -1;
774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    return s;
804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct perms_ {
834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    char *name;
844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    mode_t perm;
854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    unsigned int uid;
864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    unsigned int gid;
874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    unsigned short prefix;
884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project};
894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic struct perms_ devperms[] = {
904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/null",          0666,   AID_ROOT,       AID_ROOT,       0 },
914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/zero",          0666,   AID_ROOT,       AID_ROOT,       0 },
924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/full",          0666,   AID_ROOT,       AID_ROOT,       0 },
934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/ptmx",          0666,   AID_ROOT,       AID_ROOT,       0 },
944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/tty",           0666,   AID_ROOT,       AID_ROOT,       0 },
954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/random",        0666,   AID_ROOT,       AID_ROOT,       0 },
964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/urandom",       0666,   AID_ROOT,       AID_ROOT,       0 },
974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/ashmem",        0666,   AID_ROOT,       AID_ROOT,       0 },
984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/binder",        0666,   AID_ROOT,       AID_ROOT,       0 },
994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
1004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project	    /* logger should be world writable (for logging) but not readable */
1014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/log/",          0662,   AID_ROOT,       AID_LOG,        1 },
1024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
10346e8863d77912ad6d76ed7d258dfc554a5cdb36dDima Zavin    /* the msm hw3d client device node is world writable/readable. */
10446e8863d77912ad6d76ed7d258dfc554a5cdb36dDima Zavin    { "/dev/msm_hw3dc",     0666,   AID_ROOT,       AID_ROOT,       0 },
10546e8863d77912ad6d76ed7d258dfc554a5cdb36dDima Zavin
10637b210f56036cda41b0407e841fe79fb4db310fcDima Zavin    /* gpu driver for adreno200 is globally accessible */
10737b210f56036cda41b0407e841fe79fb4db310fcDima Zavin    { "/dev/kgsl",          0666,   AID_ROOT,       AID_ROOT,       0 },
10837b210f56036cda41b0407e841fe79fb4db310fcDima Zavin
1094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* these should not be world writable */
1106ed11ebecd3eaffd84d79706a4a3a74d39f19715Iliyan Malchev    { "/dev/diag",          0660,   AID_RADIO,      AID_RADIO,        0 },
1116ed11ebecd3eaffd84d79706a4a3a74d39f19715Iliyan Malchev    { "/dev/diag_arm9",     0660,   AID_RADIO,      AID_RADIO,        0 },
1124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/android_adb",   0660,   AID_ADB,        AID_ADB,        0 },
1134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/android_adb_enable",   0660,   AID_ADB,        AID_ADB,        0 },
11435237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project    { "/dev/ttyMSM0",       0600,   AID_BLUETOOTH,  AID_BLUETOOTH,  0 },
11535237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project    { "/dev/ttyHS0",        0600,   AID_BLUETOOTH,  AID_BLUETOOTH,  0 },
116be65da47e69c427d6326603e7eccd84957cc34d2Ken Schultz    { "/dev/uinput",        0660,   AID_SYSTEM,     AID_BLUETOOTH,  0 },
1174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/alarm",         0664,   AID_SYSTEM,     AID_RADIO,      0 },
11835237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project    { "/dev/tty0",          0660,   AID_ROOT,       AID_SYSTEM,     0 },
1194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/graphics/",     0660,   AID_ROOT,       AID_GRAPHICS,   1 },
12046e8863d77912ad6d76ed7d258dfc554a5cdb36dDima Zavin    { "/dev/msm_hw3dm",     0660,   AID_SYSTEM,     AID_GRAPHICS,   0 },
1214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/input/",        0660,   AID_ROOT,       AID_INPUT,      1 },
1224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/eac",           0660,   AID_ROOT,       AID_AUDIO,      0 },
1234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/cam",           0660,   AID_ROOT,       AID_CAMERA,     0 },
1244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/pmem",          0660,   AID_SYSTEM,     AID_GRAPHICS,   0 },
1254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/pmem_adsp",     0660,   AID_SYSTEM,     AID_AUDIO,      1 },
1264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/pmem_camera",   0660,   AID_SYSTEM,     AID_CAMERA,     1 },
1274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/oncrpc/",       0660,   AID_ROOT,       AID_SYSTEM,     1 },
1284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/adsp/",         0660,   AID_SYSTEM,     AID_AUDIO,      1 },
129102f6d2c64bbf55e1ec47061a0bc0bcd24991127Sean McNeil    { "/dev/snd/",          0660,   AID_SYSTEM,     AID_AUDIO,      1 },
1304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/mt9t013",       0660,   AID_SYSTEM,     AID_SYSTEM,     0 },
131fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev    { "/dev/msm_camera/",   0660,   AID_SYSTEM,     AID_SYSTEM,     1 },
1324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/akm8976_daemon",0640,   AID_COMPASS,    AID_SYSTEM,     0 },
1334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/akm8976_aot",   0640,   AID_COMPASS,    AID_SYSTEM,     0 },
1349a52eda8c5dd9df763a63f9b71cd24847f014737Iliyan Malchev    { "/dev/akm8973_daemon",0640,   AID_COMPASS,    AID_SYSTEM,     0 },
1359a52eda8c5dd9df763a63f9b71cd24847f014737Iliyan Malchev    { "/dev/akm8973_aot",   0640,   AID_COMPASS,    AID_SYSTEM,     0 },
1369a52eda8c5dd9df763a63f9b71cd24847f014737Iliyan Malchev    { "/dev/bma150",        0640,   AID_COMPASS,    AID_SYSTEM,     0 },
1373306e0678c5e68c1b7e8d5c99499b7645e4952f3Iliyan Malchev    { "/dev/cm3602",        0640,   AID_COMPASS,    AID_SYSTEM,     0 },
1384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/akm8976_pffd",  0640,   AID_COMPASS,    AID_SYSTEM,     0 },
1393bc1e9cd7b2832d51c442c0342054e0235a383f6Iliyan Malchev    { "/dev/lightsensor",   0640,   AID_SYSTEM,     AID_SYSTEM,     0 },
1404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/msm_pcm_out",   0660,   AID_SYSTEM,     AID_AUDIO,      1 },
1414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/msm_pcm_in",    0660,   AID_SYSTEM,     AID_AUDIO,      1 },
1424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/msm_pcm_ctl",   0660,   AID_SYSTEM,     AID_AUDIO,      1 },
1435ae090ed949cea9d1e7ab1552b455a229f8f9757The Android Open Source Project    { "/dev/msm_snd",       0660,   AID_SYSTEM,     AID_AUDIO,      1 },
1444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/msm_mp3",       0660,   AID_SYSTEM,     AID_AUDIO,      1 },
145c822213603107b72bca90bd2984f4781dfcf22c4Brian Swetland    { "/dev/audience_a1026", 0660,   AID_SYSTEM,     AID_AUDIO,      1 },
1461340a095ac9f1ea007752288a4407490ddb6935cIliyan Malchev    { "/dev/tpa2018d1",     0660,   AID_SYSTEM,     AID_AUDIO,      1 },
147dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project    { "/dev/msm_audpre",    0660,   AID_SYSTEM,     AID_AUDIO,      0 },
148c822213603107b72bca90bd2984f4781dfcf22c4Brian Swetland    { "/dev/msm_audio_ctl", 0660,   AID_SYSTEM,     AID_AUDIO,      0 },
149dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project    { "/dev/htc-acoustic",  0660,   AID_SYSTEM,     AID_AUDIO,      0 },
150c84016778f9efd0d15f3c5ad7b7109833fb45c9aDima Zavin    { "/dev/vdec",          0660,   AID_SYSTEM,     AID_AUDIO,      0 },
1518234aa375896718e19b4450bcb44fa4376f53486Dima Zavin    { "/dev/q6venc",        0660,   AID_SYSTEM,     AID_AUDIO,      0 },
1521ccef18e69acdc4276a6c4a0c449ced6be395fc3Masaki Sato    { "/dev/snd/dsp",       0660,   AID_SYSTEM,     AID_AUDIO,      0 },
1531ccef18e69acdc4276a6c4a0c449ced6be395fc3Masaki Sato    { "/dev/snd/dsp1",      0660,   AID_SYSTEM,     AID_AUDIO,      0 },
1541ccef18e69acdc4276a6c4a0c449ced6be395fc3Masaki Sato    { "/dev/snd/mixer",     0660,   AID_SYSTEM,     AID_AUDIO,      0 },
1554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/smd0",          0640,   AID_RADIO,      AID_RADIO,      0 },
1564a762357d05fe2152dbe5d4b7085d01a5d4ccbf2Jack Veenstra    { "/dev/qemu_trace",    0666,   AID_SYSTEM,     AID_SYSTEM,     0 },
1574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/qmi",           0640,   AID_RADIO,      AID_RADIO,      0 },
1584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/qmi0",          0640,   AID_RADIO,      AID_RADIO,      0 },
1594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/qmi1",          0640,   AID_RADIO,      AID_RADIO,      0 },
1604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { "/dev/qmi2",          0640,   AID_RADIO,      AID_RADIO,      0 },
161e910ea596240d355a1e25b66f76fd8d8fdfbbba6Erik Gilling        /* CDMA radio interface MUX */
162e910ea596240d355a1e25b66f76fd8d8fdfbbba6Erik Gilling    { "/dev/ts0710mux",     0640,   AID_RADIO,      AID_RADIO,      1 },
16388dc657d50cb3289a9011828c497eee996ed958cChia-chi Yeh    { "/dev/ppp",           0660,   AID_RADIO,      AID_VPN,        0 },
16488dc657d50cb3289a9011828c497eee996ed958cChia-chi Yeh    { "/dev/tun",           0640,   AID_VPN,        AID_VPN,        0 },
1654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    { NULL, 0, 0, 0, 0 },
1664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project};
1674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
1684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* devperms_partners list and perm_node are for hardware specific /dev entries */
1694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstruct perm_node {
1704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    struct perms_ dp;
1714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    struct listnode plist;
1724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project};
1734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectlist_declare(devperms_partners);
1744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
1754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/*
1764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * Permission override when in emulator mode, must be parsed before
1774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project * system properties is initalized.
1784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project */
1794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int qemu_perm_count;
1804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic struct perms_ qemu_perms[MAX_QEMU_PERM + 1];
1814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
1824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectint add_devperms_partners(const char *name, mode_t perm, unsigned int uid,
1834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                        unsigned int gid, unsigned short prefix) {
1844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int size;
1854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    struct perm_node *node = malloc(sizeof (struct perm_node));
1864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (!node)
1874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return -ENOMEM;
1884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
1894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    size = strlen(name) + 1;
1904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if ((node->dp.name = malloc(size)) == NULL)
1914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return -ENOMEM;
1924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
1934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    memcpy(node->dp.name, name, size);
1944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    node->dp.perm = perm;
1954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    node->dp.uid = uid;
1964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    node->dp.gid = gid;
1974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    node->dp.prefix = prefix;
1984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
1994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    list_add_tail(&devperms_partners, &node->plist);
2004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    return 0;
2014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
2024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectvoid qemu_init(void) {
2044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    qemu_perm_count = 0;
2054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    memset(&qemu_perms, 0, sizeof(qemu_perms));
2064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
2074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int qemu_perm(const char* name, mode_t perm, unsigned int uid,
2094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                         unsigned int gid, unsigned short prefix)
2104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
2114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    char *buf;
2124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (qemu_perm_count == MAX_QEMU_PERM)
2134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return -ENOSPC;
2144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    buf = malloc(strlen(name) + 1);
2164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (!buf)
2174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return -errno;
2184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    strlcpy(buf, name, strlen(name) + 1);
2204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    qemu_perms[qemu_perm_count].name = buf;
2214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    qemu_perms[qemu_perm_count].perm = perm;
2224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    qemu_perms[qemu_perm_count].uid = uid;
2234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    qemu_perms[qemu_perm_count].gid = gid;
2244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    qemu_perms[qemu_perm_count].prefix = prefix;
2254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    qemu_perm_count++;
2274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    return 0;
2284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
2294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* Permission overrides for emulator that are parsed from /proc/cmdline. */
2314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectvoid qemu_cmdline(const char* name, const char *value)
2324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
2334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    char *buf;
2344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (!strcmp(name, "android.ril")) {
2354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* cmd line params currently assume /dev/ prefix */
2364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if (asprintf(&buf, CMDLINE_PREFIX"/%s", value) == -1) {
2374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            return;
2384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        }
2394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        INFO("nani- buf:: %s\n", buf);
2404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        qemu_perm(buf, 0660, AID_RADIO, AID_ROOT, 0);
2414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
2424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
2434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int get_device_perm_inner(struct perms_ *perms, const char *path,
2454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                                    unsigned *uid, unsigned *gid, mode_t *perm)
2464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
2474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int i;
2484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    for(i = 0; perms[i].name; i++) {
2494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(perms[i].prefix) {
2514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            if(strncmp(path, perms[i].name, strlen(perms[i].name)))
2524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                continue;
2534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        } else {
2544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            if(strcmp(path, perms[i].name))
2554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                continue;
2564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        }
2574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        *uid = perms[i].uid;
2584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        *gid = perms[i].gid;
2594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        *perm = perms[i].perm;
2604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return 0;
2614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
2624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    return -1;
2634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
2644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* First checks for emulator specific permissions specified in /proc/cmdline. */
2664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic mode_t get_device_perm(const char *path, unsigned *uid, unsigned *gid)
2674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
2684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    mode_t perm;
2694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (get_device_perm_inner(qemu_perms, path, uid, gid, &perm) == 0) {
2714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return perm;
2724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    } else if (get_device_perm_inner(devperms, path, uid, gid, &perm) == 0) {
2734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return perm;
2744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    } else {
2754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        struct listnode *node;
2764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        struct perm_node *perm_node;
2774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        struct perms_ *dp;
2784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* Check partners list. */
2804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        list_for_each(node, &devperms_partners) {
2814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            perm_node = node_to_item(node, struct perm_node, plist);
2824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            dp = &perm_node->dp;
2834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
2844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            if (dp->prefix) {
2854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                if (strncmp(path, dp->name, strlen(dp->name)))
2864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                    continue;
2874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            } else {
2884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                if (strcmp(path, dp->name))
2894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                    continue;
2904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            }
2914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            /* Found perm in partner list. */
2924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            *uid = dp->uid;
2934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            *gid = dp->gid;
2944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            return dp->perm;
2954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        }
2964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* Default if nothing found. */
2974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        *uid = 0;
2984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        *gid = 0;
2994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return 0600;
3004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
3014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
3024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void make_device(const char *path, int block, int major, int minor)
3044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
3054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    unsigned uid;
3064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    unsigned gid;
3074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    mode_t mode;
3084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    dev_t dev;
3094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(major > 255 || minor > 255)
3114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return;
3124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    mode = get_device_perm(path, &uid, &gid) | (block ? S_IFBLK : S_IFCHR);
3144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    dev = (major << 8) | minor;
3156405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly    /* Temporarily change egid to avoid race condition setting the gid of the
3166405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly     * device node. Unforunately changing the euid would prevent creation of
3176405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly     * some device nodes, so the uid has to be set with chown() and is still
3186405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly     * racy. Fixing the gid race at least fixed the issue with system_server
3196405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly     * opening dynamic input devices under the AID_INPUT gid. */
3206405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly    setegid(gid);
3214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    mknod(path, mode, dev);
3226405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly    chown(path, uid, -1);
3236405c6953fa02d41d9f6377f4cdb947604f481c4Nick Pelly    setegid(AID_ROOT);
3244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
3254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3261e070846f8908dff15086efa12fbba01ab7eae15Chuck Tuffli#if LOG_UEVENTS
3274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic inline suseconds_t get_usecs(void)
3294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
3304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    struct timeval tv;
3314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    gettimeofday(&tv, 0);
3324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    return tv.tv_sec * (suseconds_t) 1000000 + tv.tv_usec;
3334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
3344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(x...) INFO(x)
3364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#else
3384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define log_event_print(fmt, args...)   do { } while (0)
3404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define get_usecs()                     0
3414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#endif
3434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void parse_event(const char *msg, struct uevent *uevent)
3454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
3464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    uevent->action = "";
3474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    uevent->path = "";
3484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    uevent->subsystem = "";
3494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    uevent->firmware = "";
3504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    uevent->major = -1;
3514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    uevent->minor = -1;
352b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    uevent->partition_name = NULL;
353b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    uevent->partition_num = -1;
3544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* currently ignoring SEQNUM */
3564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    while(*msg) {
3574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(!strncmp(msg, "ACTION=", 7)) {
3584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            msg += 7;
3594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            uevent->action = msg;
3604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        } else if(!strncmp(msg, "DEVPATH=", 8)) {
3614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            msg += 8;
3624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            uevent->path = msg;
3634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        } else if(!strncmp(msg, "SUBSYSTEM=", 10)) {
3644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            msg += 10;
3654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            uevent->subsystem = msg;
3664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        } else if(!strncmp(msg, "FIRMWARE=", 9)) {
3674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            msg += 9;
3684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            uevent->firmware = msg;
3694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        } else if(!strncmp(msg, "MAJOR=", 6)) {
3704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            msg += 6;
3714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            uevent->major = atoi(msg);
3724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        } else if(!strncmp(msg, "MINOR=", 6)) {
3734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            msg += 6;
3744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            uevent->minor = atoi(msg);
375b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        } else if(!strncmp(msg, "PARTN=", 6)) {
376b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            msg += 6;
377b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            uevent->partition_num = atoi(msg);
378b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        } else if(!strncmp(msg, "PARTNAME=", 9)) {
379b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            msg += 9;
380b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            uevent->partition_name = msg;
3814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        }
3824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            /* advance to after the next \0 */
3844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        while(*msg++)
3854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            ;
3864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
3874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
3884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    log_event_print("event { '%s', '%s', '%s', '%s', %d, %d }\n",
3894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                    uevent->action, uevent->path, uevent->subsystem,
3904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                    uevent->firmware, uevent->major, uevent->minor);
3914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
3924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
393b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Crossstatic char **parse_platform_block_device(struct uevent *uevent)
394b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross{
395b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    const char *driver;
396b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    const char *path;
397b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    char *slash;
398b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    int width;
399b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    char buf[256];
400b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    char link_path[256];
401b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    int fd;
402b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    int link_num = 0;
403b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    int ret;
404b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    char *p;
405b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    unsigned int size;
406b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    struct stat info;
407b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
408b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    char **links = malloc(sizeof(char *) * 4);
409b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    if (!links)
410b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        return NULL;
411b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    memset(links, 0, sizeof(char *) * 4);
412b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
413b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    /* Drop "/devices/platform/" */
414b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    path = uevent->path;
415b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    driver = path + 18;
416b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    slash = strchr(driver, '/');
417b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    if (!slash)
418b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        goto err;
419b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    width = slash - driver;
420b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    if (width <= 0)
421b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        goto err;
422b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
423b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    snprintf(link_path, sizeof(link_path), "/dev/block/platform/%.*s",
424b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross             width, driver);
425b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
426b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    if (uevent->partition_name) {
427b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        p = strdup(uevent->partition_name);
428b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        sanitize(p);
429b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        if (asprintf(&links[link_num], "%s/by-name/%s", link_path, p) > 0)
430b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            link_num++;
431b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        else
432b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            links[link_num] = NULL;
433b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        free(p);
434b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    }
435b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
436b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    if (uevent->partition_num >= 0) {
437b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        if (asprintf(&links[link_num], "%s/by-num/p%d", link_path, uevent->partition_num) > 0)
438b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            link_num++;
439b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        else
440b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            links[link_num] = NULL;
441b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    }
442b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
443b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    slash = strrchr(path, '/');
444b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    if (asprintf(&links[link_num], "%s/%s", link_path, slash + 1) > 0)
445b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        link_num++;
446b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    else
447b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        links[link_num] = NULL;
448b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
449b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    return links;
450b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
451b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Crosserr:
452b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    free(links);
453b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    return NULL;
454b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross}
455b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
4564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void handle_device_event(struct uevent *uevent)
4574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
4584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    char devpath[96];
4594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    char *base, *name;
460b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    char **links = NULL;
4614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int block;
462b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    int i;
4634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
4644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* if it's not a /dev device, nothing to do */
4654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if((uevent->major < 0) || (uevent->minor < 0))
4664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return;
4674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
4684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* do we have a name? */
4694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    name = strrchr(uevent->path, '/');
4704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(!name)
4714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return;
4724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    name++;
4734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
4744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* too-long names would overrun our buffer */
4754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(strlen(name) > 64)
4764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return;
4774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
4784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        /* are we block or char? where should we live? */
47935237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project    if(!strncmp(uevent->subsystem, "block", 5)) {
4804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        block = 1;
4814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        base = "/dev/block/";
4824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        mkdir(base, 0755);
483b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        if (!strncmp(uevent->path, "/devices/platform/", 18))
484b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            links = parse_platform_block_device(uevent);
4854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    } else {
4864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        block = 0;
4874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            /* this should probably be configurable somehow */
48835237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project        if(!strncmp(uevent->subsystem, "graphics", 8)) {
4894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            base = "/dev/graphics/";
4904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            mkdir(base, 0755);
49135237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project        } else if (!strncmp(uevent->subsystem, "oncrpc", 6)) {
4924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            base = "/dev/oncrpc/";
4934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            mkdir(base, 0755);
49435237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project        } else if (!strncmp(uevent->subsystem, "adsp", 4)) {
4954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            base = "/dev/adsp/";
4964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            mkdir(base, 0755);
497fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev        } else if (!strncmp(uevent->subsystem, "msm_camera", 10)) {
498fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev            base = "/dev/msm_camera/";
499fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev            mkdir(base, 0755);
500fc0182eb1db0620eb71fb6ca219b15a17dcd912fIliyan Malchev        } else if(!strncmp(uevent->subsystem, "input", 5)) {
5014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            base = "/dev/input/";
5024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            mkdir(base, 0755);
50335237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project        } else if(!strncmp(uevent->subsystem, "mtd", 3)) {
5044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            base = "/dev/mtd/";
5054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            mkdir(base, 0755);
5065bb44c8ea2bc513fefc526918980ab3d17494eccXiaopeng Yang        } else if(!strncmp(uevent->subsystem, "sound", 5)) {
5075bb44c8ea2bc513fefc526918980ab3d17494eccXiaopeng Yang            base = "/dev/snd/";
5085bb44c8ea2bc513fefc526918980ab3d17494eccXiaopeng Yang            mkdir(base, 0755);
50935237d135807af84bf9b0e5b8d7f8633e58db6f5The Android Open Source Project        } else if(!strncmp(uevent->subsystem, "misc", 4) &&
5104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                    !strncmp(name, "log_", 4)) {
5114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            base = "/dev/log/";
5124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            mkdir(base, 0755);
5134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            name += 4;
5144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        } else
5154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            base = "/dev/";
5164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
5174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    snprintf(devpath, sizeof(devpath), "%s%s", base, name);
5194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(!strcmp(uevent->action, "add")) {
5214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        make_device(devpath, block, uevent->major, uevent->minor);
522b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        if (links) {
523b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            for (i = 0; links[i]; i++)
524b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross                make_link(devpath, links[i]);
525b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        }
5264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
5274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(!strcmp(uevent->action, "remove")) {
529b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        if (links) {
530b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            for (i = 0; links[i]; i++)
531b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross                remove_link(devpath, links[i]);
532b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        }
5334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        unlink(devpath);
534b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    }
535b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross
536b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross    if (links) {
537b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        for (i = 0; links[i]; i++)
538b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross            free(links[i]);
539b0ab94b7d5a888f0b6920b156e5c6a075fa0741aColin Cross        free(links);
5404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
5414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
5424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic int load_firmware(int fw_fd, int loading_fd, int data_fd)
5444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
5454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    struct stat st;
5464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    long len_to_copy;
5474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int ret = 0;
5484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(fstat(fw_fd, &st) < 0)
5504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return -1;
5514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    len_to_copy = st.st_size;
5524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    write(loading_fd, "1", 1);  /* start transfer */
5544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    while (len_to_copy > 0) {
5564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        char buf[PAGE_SIZE];
5574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        ssize_t nr;
5584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        nr = read(fw_fd, buf, sizeof(buf));
5604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(!nr)
5614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            break;
5624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(nr < 0) {
5634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            ret = -1;
5644f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            break;
5654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        }
5664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        len_to_copy -= nr;
5684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        while (nr > 0) {
5694f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            ssize_t nw = 0;
5704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            nw = write(data_fd, buf + nw, nr);
5724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            if(nw <= 0) {
5734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                ret = -1;
5744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                goto out;
5754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            }
5764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            nr -= nw;
5774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        }
5784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
5794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectout:
5814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(!ret)
5824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        write(loading_fd, "0", 1);  /* successful end of transfer */
5834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    else
5844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        write(loading_fd, "-1", 2); /* abort transfer */
5854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    return ret;
5874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
5884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void process_firmware_event(struct uevent *uevent)
5904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
5914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    char *root, *loading, *data, *file;
5924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int l, loading_fd, data_fd, fw_fd;
5934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5944f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    log_event_print("firmware event { '%s', '%s' }\n",
5954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project                    uevent->path, uevent->firmware);
5964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
5974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    l = asprintf(&root, SYSFS_PREFIX"%s/", uevent->path);
5984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (l == -1)
5994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return;
6004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    l = asprintf(&loading, "%sloading", root);
6024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (l == -1)
6034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        goto root_free_out;
6044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6054f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    l = asprintf(&data, "%sdata", root);
6064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (l == -1)
6074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        goto loading_free_out;
6084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    l = asprintf(&file, FIRMWARE_DIR"/%s", uevent->firmware);
6104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (l == -1)
6114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        goto data_free_out;
6124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    loading_fd = open(loading, O_WRONLY);
6144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(loading_fd < 0)
6154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        goto file_free_out;
6164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    data_fd = open(data, O_WRONLY);
6184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(data_fd < 0)
6194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        goto loading_close_out;
6204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    fw_fd = open(file, O_RDONLY);
6224f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(fw_fd < 0)
6234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        goto data_close_out;
6244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(!load_firmware(fw_fd, loading_fd, data_fd))
6264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        log_event_print("firmware copy success { '%s', '%s' }\n", root, file);
6274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    else
6284f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        log_event_print("firmware copy failure { '%s', '%s' }\n", root, file);
6294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    close(fw_fd);
6314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_close_out:
6324f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    close(data_fd);
6334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_close_out:
6344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    close(loading_fd);
6354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectfile_free_out:
6364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    free(file);
6374f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectdata_free_out:
6384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    free(data);
6394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectloading_free_out:
6404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    free(loading);
6414f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectroot_free_out:
6424f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    free(root);
6434f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
6444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6454f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Projectstatic void handle_firmware_event(struct uevent *uevent)
6464f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
6474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    pid_t pid;
6484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6494f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(strcmp(uevent->subsystem, "firmware"))
6504f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return;
6514f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(strcmp(uevent->action, "add"))
6534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        return;
6544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6554f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    /* we fork, to avoid making large memory allocations in init proper */
6564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    pid = fork();
6574f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if (!pid) {
6584f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        process_firmware_event(uevent);
6594f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        exit(EXIT_SUCCESS);
6604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
6614f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
6624f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6634f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project#define UEVENT_MSG_LEN  1024
6640dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid handle_device_fd()
6654f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
6664f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    char msg[UEVENT_MSG_LEN+2];
6674f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int n;
6684f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6690dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    while((n = recv(device_fd, msg, UEVENT_MSG_LEN, 0)) > 0) {
6704f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        struct uevent uevent;
6714f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6724f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(n == UEVENT_MSG_LEN)   /* overflow -- discard */
6734f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            continue;
6744f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6754f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        msg[n] = '\0';
6764f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        msg[n+1] = '\0';
6774f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6784f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        parse_event(msg, &uevent);
6794f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6804f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        handle_device_event(&uevent);
6814f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        handle_firmware_event(&uevent);
6824f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
6834f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
6844f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6854f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project/* Coldboot walks parts of the /sys tree and pokes the uevent files
6864f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** to cause the kernel to regenerate device add events that happened
6874f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** before init's device manager was started
6884f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project**
6894f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** We drain any pending events from the netlink socket every time
6904f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** we poke another uevent file to make sure we don't overrun the
6914f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project** socket's buffer.
6924f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project*/
6934f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6940dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void do_coldboot(DIR *d)
6954f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
6964f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    struct dirent *de;
6974f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    int dfd, fd;
6984f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
6994f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    dfd = dirfd(d);
7004f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7014f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    fd = openat(dfd, "uevent", O_WRONLY);
7024f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(fd >= 0) {
7034f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        write(fd, "add\n", 4);
7044f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        close(fd);
7050dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross        handle_device_fd();
7064f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
7074f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7084f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    while((de = readdir(d))) {
7094f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        DIR *d2;
7104f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7114f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(de->d_type != DT_DIR || de->d_name[0] == '.')
7124f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            continue;
7134f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7144f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        fd = openat(dfd, de->d_name, O_RDONLY | O_DIRECTORY);
7154f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(fd < 0)
7164f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            continue;
7174f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7184f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        d2 = fdopendir(fd);
7194f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        if(d2 == 0)
7204f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            close(fd);
7214f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        else {
7220dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross            do_coldboot(d2);
7234f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project            closedir(d2);
7244f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        }
7254f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
7264f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
7274f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7280dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossstatic void coldboot(const char *path)
7294f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
7304f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    DIR *d = opendir(path);
7314f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    if(d) {
7320dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross        do_coldboot(d);
7334f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project        closedir(d);
7344f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    }
7354f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
7364f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7370dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossvoid device_init(void)
7384f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project{
7394f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    suseconds_t t0, t1;
7404f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7410dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    device_fd = open_uevent_socket();
7420dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    if(device_fd < 0)
7430dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross        return;
7444f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7450dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    fcntl(device_fd, F_SETFD, FD_CLOEXEC);
7460dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    fcntl(device_fd, F_SETFL, O_NONBLOCK);
7474f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7484f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    t0 = get_usecs();
7490dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    coldboot("/sys/class");
7500dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    coldboot("/sys/block");
7510dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    coldboot("/sys/devices");
7524f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    t1 = get_usecs();
7534f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7544f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project    log_event_print("coldboot %ld uS\n", ((long) (t1 - t0)));
7550dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross}
7564f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project
7570dd7ca6e87abb689700c5e3a816a949b03b1154bColin Crossint get_device_fd()
7580dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross{
7590dd7ca6e87abb689700c5e3a816a949b03b1154bColin Cross    return device_fd;
7604f6e8d7a00cbeda1e70cc15be9c4af1018bdad5The Android Open Source Project}
761