2009-02-18 23:48:23 +01:00
|
|
|
/* Disk protection for HP machines.
|
|
|
|
*
|
|
|
|
* Copyright 2008 Eric Piel
|
|
|
|
* Copyright 2009 Pavel Machek <pavel@suse.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>
|
2009-07-25 20:55:15 +02:00
|
|
|
#include <sys/mman.h>
|
|
|
|
#include <sched.h>
|
2009-02-18 23:48:23 +01:00
|
|
|
|
|
|
|
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("/sys/block/sda/device/unload_heads", 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);
|
|
|
|
}
|
|
|
|
|
2009-06-22 11:08:36 +02:00
|
|
|
int main(int argc, char *argv[])
|
2009-02-18 23:48:23 +01:00
|
|
|
{
|
2009-06-22 11:08:36 +02:00
|
|
|
int fd, ret;
|
2009-07-25 20:55:15 +02:00
|
|
|
struct sched_param param;
|
2009-02-18 23:48:23 +01:00
|
|
|
|
2009-06-22 11:08:36 +02:00
|
|
|
fd = open("/dev/freefall", O_RDONLY);
|
|
|
|
if (fd < 0) {
|
|
|
|
perror("open");
|
|
|
|
return EXIT_FAILURE;
|
|
|
|
}
|
2009-02-18 23:48:23 +01:00
|
|
|
|
2009-07-25 20:55:15 +02:00
|
|
|
daemon(0, 0);
|
|
|
|
param.sched_priority = sched_get_priority_max(SCHED_FIFO);
|
|
|
|
sched_setscheduler(0, SCHED_FIFO, ¶m);
|
|
|
|
mlockall(MCL_CURRENT|MCL_FUTURE);
|
|
|
|
|
2009-02-18 23:48:23 +01:00
|
|
|
signal(SIGALRM, ignore_me);
|
|
|
|
|
2009-06-22 11:08:36 +02:00
|
|
|
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);
|
|
|
|
}
|
2009-02-18 23:48:23 +01:00
|
|
|
|
2009-06-22 11:08:36 +02:00
|
|
|
close(fd);
|
|
|
|
return EXIT_SUCCESS;
|
2009-02-18 23:48:23 +01:00
|
|
|
}
|