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
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
|
/*
* A simple firmware helper program.
*
* Copyright 2005 Red Hat, Inc.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms of the GNU General Public License as published by the
* Free Software Foundation version 2 of the License.
*/
#include <errno.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <syslog.h>
#include <unistd.h>
#include <sys/stat.h>
#include "../../udev.h"
#define FIRMWARE_PATH "/lib/firmware"
#define PATH_SIZE 256
#ifdef USE_LOG
void log_message(int priority, const char *format, ...)
{
va_list args;
static int udev_log = -1;
if (udev_log == -1) {
const char *value;
value = getenv("UDEV_LOG");
if (value)
udev_log = log_priority(value);
else
udev_log = LOG_ERR;
}
if (priority > udev_log)
return;
va_start(args, format);
vsyslog(priority, format, args);
va_end(args);
}
#endif
/* Set the 'loading' attribute for a firmware device.
* 1 == currently loading
* 0 == done loading
* -1 == error
*/
static int set_loading(const char *device, int value) {
char loading_path[PATH_SIZE];
int rc;
FILE *f;
snprintf(loading_path, sizeof(loading_path), "/sys/%s/loading", device);
loading_path[sizeof(loading_path)-1] = '\0';
f = fopen(loading_path, "w");
if (!f)
return -1;
rc = fprintf(f, "%d", value);
fclose(f);
if (rc < 0)
return rc;
return 0;
}
int main(int argc, char **argv) {
char *devpath, *firmware, *action, *driver;
char fw_path[PATH_SIZE];
char data_path[PATH_SIZE];
int fw_fd;
char *fw_buffer;
size_t fw_buffer_size;
size_t count;
int rc = 0;
logging_init("firmware_helper");
driver = getenv("PHYSDEVDRIVER");
if (!driver)
driver = "(unknown)";
devpath = getenv("DEVPATH");
firmware = getenv("FIRMWARE");
action = getenv("ACTION");
if (!devpath || !firmware || !action || strcmp(action,"add") != 0) {
err("missing devpath, action or firmware");
exit(1);
}
dbg("try to load firmware '%s' for '%s'", firmware, devpath);
set_loading(devpath, 1);
snprintf(fw_path, sizeof(fw_path), "%s/%s", FIRMWARE_PATH, firmware);
fw_path[sizeof(fw_path)-1] = '\0';
if (file_map(fw_path, &fw_buffer, &fw_buffer_size) != 0 || fw_buffer_size == 0) {
err("could not load firmware '%s' for '%s'", fw_path, devpath);
fw_buffer = NULL;
goto out_err;
}
snprintf(data_path, sizeof(data_path), "/sys/%s/data", devpath);
data_path[sizeof(data_path)-1] = '\0';
fw_fd = open(data_path, O_RDWR);
if (fw_fd < 0) {
rc = errno;
goto out_err;
}
count = 0;
while (count < fw_buffer_size) {
ssize_t c;
c = write(fw_fd, fw_buffer+count, fw_buffer_size-count);
if (c <= 0) {
rc = errno;
close(fw_fd);
goto out_err;
}
count += c;
}
close(fw_fd);
file_unmap(fw_buffer, fw_buffer_size);
set_loading(devpath, 0);
info("loaded '%s' for device '%s'", fw_path, devpath);
logging_close();
return 0;
out_err:
if (fw_buffer)
file_unmap(fw_buffer, fw_buffer_size);
set_loading(devpath, -1);
err("error loading '%s' for device '%s' with driver '%s'", fw_path, devpath, driver);
logging_close();
return rc;
}
|
