summaryrefslogtreecommitdiffstats
path: root/vold/switch.c
blob: d8dab4327e217fd3dcceda26018134386a4a2d11 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124

/*
 * Copyright (C) 2008 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include <stdlib.h>
#include <string.h>
#include <dirent.h>
#include <errno.h>

#include <sys/types.h>

#include "vold.h"
#include "switch.h"

#define DEBUG_BOOTSTRAP 0

static int mmc_bootstrap_switch(char *sysfs_path);

int switch_bootstrap()
{
    DIR *d;
    struct dirent *de;

    if (!(d = opendir(SYSFS_CLASS_SWITCH_PATH))) {
        LOG_ERROR("Unable to open '%s' (%s)", SYSFS_CLASS_SWITCH_PATH,
                   strerror(errno));
        return -errno;
    }

    while ((de = readdir(d))) {
        char tmp[255];

        if (de->d_name[0] == '.')
            continue;

        sprintf(tmp, "%s/%s", SYSFS_CLASS_SWITCH_PATH, de->d_name);
        if (mmc_bootstrap_switch(tmp)) {
            LOG_ERROR("Error bootstrapping switch '%s' (%s)", tmp,
                      strerror(errno));
        }
    }

    closedir(d);

    return 0;
}

static int mmc_bootstrap_switch(char *sysfs_path)
{
#if DEBUG_BOOTSTRAP
    LOG_VOL("bootstrap_switch(%s):", sysfs_path);
#endif

    char filename[255];
    char name[255];
    char state[255];
    char tmp[255];
    char *uevent_params[3];
    char devpath[255];
    FILE *fp;

    /*
     * Read switch name
     */
    sprintf(filename, "%s/name", sysfs_path);
    if (!(fp = fopen(filename, "r"))) {
        LOGE("Error opening switch name path '%s' (%s)",
             sysfs_path, strerror(errno));
       return -errno;
    }
    if (!fgets(name, sizeof(name), fp)) {
        LOGE("Unable to read switch name");
        fclose(fp);
        return -EIO;
    }
    fclose(fp);

    name[strlen(name) -1] = '\0';
    sprintf(devpath, "/devices/virtual/switch/%s", name);
    sprintf(tmp, "SWITCH_NAME=%s", name);
    uevent_params[0] = (char *) strdup(tmp);

    /*
     * Read switch state
     */
    sprintf(filename, "%s/state", sysfs_path);
    if (!(fp = fopen(filename, "r"))) {
        LOGE("Error opening switch state path '%s' (%s)",
             sysfs_path, strerror(errno));
       return -errno;
    }
    if (!fgets(state, sizeof(state), fp)) {
        LOGE("Unable to read switch state");
        fclose(fp);
        return -EIO;
    }
    fclose(fp);

    state[strlen(state) -1] = '\0';
    sprintf(tmp, "SWITCH_STATE=%s", state);
    uevent_params[1] = (char *) strdup(tmp);

    uevent_params[2] = (char *) NULL;

    if (simulate_uevent("switch", devpath, "add", uevent_params) < 0) {
        LOGE("Error simulating uevent (%s)", strerror(errno));
        return -errno;
    }

    return 0;   
}