diff options
-rw-r--r-- | Documentation/hwmon/hpfall.c | 45 |
1 files changed, 42 insertions, 3 deletions
diff --git a/Documentation/hwmon/hpfall.c b/Documentation/hwmon/hpfall.c index a3cfe1a5f964..681ec22b9d0e 100644 --- a/Documentation/hwmon/hpfall.c +++ b/Documentation/hwmon/hpfall.c | |||
@@ -19,6 +19,32 @@ | |||
19 | #include <sys/mman.h> | 19 | #include <sys/mman.h> |
20 | #include <sched.h> | 20 | #include <sched.h> |
21 | 21 | ||
22 | char unload_heads_path[64]; | ||
23 | |||
24 | int set_unload_heads_path(char *device) | ||
25 | { | ||
26 | char devname[64]; | ||
27 | |||
28 | if (strlen(device) <= 5 || strncmp(device, "/dev/", 5) != 0) | ||
29 | return -EINVAL; | ||
30 | strncpy(devname, device + 5, sizeof(devname)); | ||
31 | |||
32 | snprintf(unload_heads_path, sizeof(unload_heads_path), | ||
33 | "/sys/block/%s/device/unload_heads", devname); | ||
34 | return 0; | ||
35 | } | ||
36 | int valid_disk(void) | ||
37 | { | ||
38 | int fd = open(unload_heads_path, O_RDONLY); | ||
39 | if (fd < 0) { | ||
40 | perror(unload_heads_path); | ||
41 | return 0; | ||
42 | } | ||
43 | |||
44 | close(fd); | ||
45 | return 1; | ||
46 | } | ||
47 | |||
22 | void write_int(char *path, int i) | 48 | void write_int(char *path, int i) |
23 | { | 49 | { |
24 | char buf[1024]; | 50 | char buf[1024]; |
@@ -42,7 +68,7 @@ void set_led(int on) | |||
42 | 68 | ||
43 | void protect(int seconds) | 69 | void protect(int seconds) |
44 | { | 70 | { |
45 | write_int("/sys/block/sda/device/unload_heads", seconds*1000); | 71 | write_int(unload_heads_path, seconds*1000); |
46 | } | 72 | } |
47 | 73 | ||
48 | int on_ac(void) | 74 | int on_ac(void) |
@@ -61,14 +87,27 @@ void ignore_me(void) | |||
61 | set_led(0); | 87 | set_led(0); |
62 | } | 88 | } |
63 | 89 | ||
64 | int main(int argc, char *argv[]) | 90 | int main(int argc, char **argv) |
65 | { | 91 | { |
66 | int fd, ret; | 92 | int fd, ret; |
67 | struct sched_param param; | 93 | struct sched_param param; |
68 | 94 | ||
95 | if (argc == 1) | ||
96 | ret = set_unload_heads_path("/dev/sda"); | ||
97 | else if (argc == 2) | ||
98 | ret = set_unload_heads_path(argv[1]); | ||
99 | else | ||
100 | ret = -EINVAL; | ||
101 | |||
102 | if (ret || !valid_disk()) { | ||
103 | fprintf(stderr, "usage: %s <device> (default: /dev/sda)\n", | ||
104 | argv[0]); | ||
105 | exit(1); | ||
106 | } | ||
107 | |||
69 | fd = open("/dev/freefall", O_RDONLY); | 108 | fd = open("/dev/freefall", O_RDONLY); |
70 | if (fd < 0) { | 109 | if (fd < 0) { |
71 | perror("open"); | 110 | perror("/dev/freefall"); |
72 | return EXIT_FAILURE; | 111 | return EXIT_FAILURE; |
73 | } | 112 | } |
74 | 113 | ||