| /* Disk protection for HP machines. |
| * |
| * Copyright 2008 Eric Piel |
| * Copyright 2009 Pavel Machek <pavel@ucw.cz> |
| * |
| * GPLv2. |
| */ |
| |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <unistd.h> |
| #include <fcntl.h> |
| #include <sys/stat.h> |
| #include <sys/types.h> |
| #include <string.h> |
| #include <stdint.h> |
| #include <errno.h> |
| #include <signal.h> |
| #include <sys/mman.h> |
| #include <sched.h> |
| |
| char unload_heads_path[64]; |
| |
| int set_unload_heads_path(char *device) |
| { |
| char devname[64]; |
| |
| if (strlen(device) <= 5 || strncmp(device, "/dev/", 5) != 0) |
| return -EINVAL; |
| strncpy(devname, device + 5, sizeof(devname)); |
| |
| snprintf(unload_heads_path, sizeof(unload_heads_path), |
| "/sys/block/%s/device/unload_heads", devname); |
| return 0; |
| } |
| int valid_disk(void) |
| { |
| int fd = open(unload_heads_path, O_RDONLY); |
| if (fd < 0) { |
| perror(unload_heads_path); |
| return 0; |
| } |
| |
| close(fd); |
| return 1; |
| } |
| |
| void write_int(char *path, int i) |
| { |
| char buf[1024]; |
| int fd = open(path, O_RDWR); |
| if (fd < 0) { |
| perror("open"); |
| exit(1); |
| } |
| sprintf(buf, "%d", i); |
| if (write(fd, buf, strlen(buf)) != strlen(buf)) { |
| perror("write"); |
| exit(1); |
| } |
| close(fd); |
| } |
| |
| void set_led(int on) |
| { |
| write_int("/sys/class/leds/hp::hddprotect/brightness", on); |
| } |
| |
| void protect(int seconds) |
| { |
| write_int(unload_heads_path, seconds*1000); |
| } |
| |
| int on_ac(void) |
| { |
| // /sys/class/power_supply/AC0/online |
| } |
| |
| int lid_open(void) |
| { |
| // /proc/acpi/button/lid/LID/state |
| } |
| |
| void ignore_me(void) |
| { |
| protect(0); |
| set_led(0); |
| } |
| |
| int main(int argc, char **argv) |
| { |
| int fd, ret; |
| struct sched_param param; |
| |
| if (argc == 1) |
| ret = set_unload_heads_path("/dev/sda"); |
| else if (argc == 2) |
| ret = set_unload_heads_path(argv[1]); |
| else |
| ret = -EINVAL; |
| |
| if (ret || !valid_disk()) { |
| fprintf(stderr, "usage: %s <device> (default: /dev/sda)\n", |
| argv[0]); |
| exit(1); |
| } |
| |
| fd = open("/dev/freefall", O_RDONLY); |
| if (fd < 0) { |
| perror("/dev/freefall"); |
| return EXIT_FAILURE; |
| } |
| |
| daemon(0, 0); |
| param.sched_priority = sched_get_priority_max(SCHED_FIFO); |
| sched_setscheduler(0, SCHED_FIFO, ¶m); |
| mlockall(MCL_CURRENT|MCL_FUTURE); |
| |
| signal(SIGALRM, ignore_me); |
| |
| for (;;) { |
| unsigned char count; |
| |
| ret = read(fd, &count, sizeof(count)); |
| alarm(0); |
| if ((ret == -1) && (errno == EINTR)) { |
| /* Alarm expired, time to unpark the heads */ |
| continue; |
| } |
| |
| if (ret != sizeof(count)) { |
| perror("read"); |
| break; |
| } |
| |
| protect(21); |
| set_led(1); |
| if (1 || on_ac() || lid_open()) |
| alarm(2); |
| else |
| alarm(20); |
| } |
| |
| close(fd); |
| return EXIT_SUCCESS; |
| } |