|  | /* 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; | 
|  | } |