350 lines
7.1 KiB
C
350 lines
7.1 KiB
C
/*
|
|
* LP (Laptop Package)
|
|
*
|
|
* Copyright (C) 1994 by HOSOKAWA Tatasumi <hosokawa@mt.cs.keio.ac.jp>
|
|
*
|
|
* This software may be used, modified, copied, distributed, and sold,
|
|
* in both source and binary form provided that the above copyright and
|
|
* these terms are retained. Under no circumstances is the author
|
|
* responsible for the proper functioning of this software, nor does
|
|
* the author assume any responsibility for damages incurred with its
|
|
* use.
|
|
*
|
|
* Sep., 1994 Implemented on FreeBSD 1.1.5.1R (Toshiba AVS001WD)
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sys/file.h>
|
|
#include <sys/ioctl.h>
|
|
#include <machine/apm_bios.h>
|
|
|
|
#define CONFIGFILE "/etc/apm.conf"
|
|
#define APMDEV "/dev/apm"
|
|
|
|
static const char *config_file = CONFIGFILE;
|
|
static int init = 0;
|
|
static int flush = 0, verbose = 0;
|
|
static int enable = 0, disable = 0;
|
|
static int haltcpu = 0, nothaltcpu = 0;
|
|
static int main_argc;
|
|
static char **main_argv;
|
|
|
|
static void
|
|
parse_option(void)
|
|
{
|
|
int i, option;
|
|
char *optarg;
|
|
enum {OPT_NONE, OPT_INIT, OPT_CONFFILE, OPT_FLUSH, OPT_VERBOSE,
|
|
OPT_ENABLE, OPT_DISABLE, OPT_HALTCPU, OPT_NOTHALTCPU} mode;
|
|
|
|
for (i = 1; i < main_argc; i++) {
|
|
option = 0;
|
|
mode = OPT_NONE;
|
|
if (main_argv[i][0] == '-') {
|
|
switch (main_argv[i][1]) {
|
|
case 'f':
|
|
mode = OPT_CONFFILE;
|
|
option = 1;
|
|
break;
|
|
case 'i':
|
|
mode = OPT_INIT;
|
|
option = 0;
|
|
break;
|
|
case 'x':
|
|
mode = OPT_FLUSH;
|
|
option = 0;
|
|
break;
|
|
case 'v':
|
|
mode = OPT_VERBOSE;
|
|
option = 0;
|
|
break;
|
|
case 'e':
|
|
mode = OPT_ENABLE;
|
|
option = 0;
|
|
break;
|
|
case 'd':
|
|
mode = OPT_DISABLE;
|
|
option = 0;
|
|
break;
|
|
case 'h':
|
|
mode = OPT_HALTCPU;
|
|
option = 0;
|
|
break;
|
|
case 't':
|
|
mode = OPT_NOTHALTCPU;
|
|
option = 0;
|
|
break;
|
|
default:
|
|
fprintf(stderr, "%s: Unknown option '%s.'\n", main_argv[0], main_argv[i]);
|
|
exit(1);
|
|
}
|
|
}
|
|
if (option) {
|
|
if (i == main_argc - 1) {
|
|
fprintf(stderr, "%s: Option '%s' needs arguments.\n", main_argv[0], main_argv[i]);
|
|
exit(1);
|
|
}
|
|
optarg = main_argv[++i];
|
|
}
|
|
|
|
switch (mode) {
|
|
case OPT_CONFFILE:
|
|
config_file = optarg;
|
|
break;
|
|
case OPT_INIT:
|
|
init = 1;
|
|
break;
|
|
case OPT_FLUSH:
|
|
flush = 1;
|
|
break;
|
|
case OPT_VERBOSE:
|
|
verbose = 1;
|
|
break;
|
|
case OPT_ENABLE:
|
|
enable = 1;
|
|
break;
|
|
case OPT_DISABLE:
|
|
disable = 1;
|
|
break;
|
|
case OPT_HALTCPU:
|
|
haltcpu = 1;
|
|
break;
|
|
case OPT_NOTHALTCPU:
|
|
nothaltcpu = 1;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
static struct apm_eqv_event eqv_event[APM_MAX_EQUIV_EVENTS];
|
|
static int eqv_num = 0;
|
|
|
|
static apm_eqv_event_t
|
|
get_eqv_event(int id)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < eqv_num; i++) {
|
|
if (id == eqv_event[i].aee_event) {
|
|
return &eqv_event[i];
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
#define PMEV_SYMBOL(name) {#name, name}
|
|
#define ARRAY_SIZEOF(array) (sizeof(array) / sizeof(array[0]))
|
|
|
|
typedef struct pmev_symbol {
|
|
char *name;
|
|
int id;
|
|
} *pmev_symbol_t;
|
|
|
|
static struct pmev_symbol pmev_symbols[] = {
|
|
PMEV_SYMBOL(PMEV_NOEVENT),
|
|
PMEV_SYMBOL(PMEV_STANDBYREQ),
|
|
PMEV_SYMBOL(PMEV_SUSPENDREQ),
|
|
PMEV_SYMBOL(PMEV_NORMRESUME),
|
|
PMEV_SYMBOL(PMEV_CRITRESUME),
|
|
PMEV_SYMBOL(PMEV_BATTERYLOW),
|
|
PMEV_SYMBOL(PMEV_POWERSTATECHANGE),
|
|
PMEV_SYMBOL(PMEV_UPDATETIME),
|
|
PMEV_SYMBOL(PMEV_CRITSUSPEND),
|
|
PMEV_SYMBOL(PMEV_USERSTANDBYREQ),
|
|
PMEV_SYMBOL(PMEV_USERSUSPENDREQ),
|
|
PMEV_SYMBOL(PMEV_STANDBYRESUME),
|
|
};
|
|
|
|
static int
|
|
pmev(char *name, int *id)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZEOF(pmev_symbols); i++) {
|
|
if (strcasecmp(pmev_symbols[i].name, name) == 0) {
|
|
*id = pmev_symbols[i].id;
|
|
return 0;
|
|
}
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
static void
|
|
parse_config_file(FILE *fp)
|
|
{
|
|
int i, id, id_eqv, n;
|
|
char *bufp, *lastp;
|
|
char buffer[1024];
|
|
char mode[64], event[64], equiv[64];
|
|
apm_eqv_event_t table;
|
|
enum {MODE_DEFAULT, MODE_RESUME} mode_type;
|
|
|
|
for (i = 1; fgets(buffer, sizeof(buffer), fp); i++) {
|
|
if (*buffer == '#') {
|
|
continue;
|
|
}
|
|
n = sscanf(buffer, "%s %s %s", mode, event, equiv);
|
|
if (n != 3) {
|
|
if (n == EOF) {
|
|
continue; /* Empty line */
|
|
}
|
|
fprintf(stderr, "%s:%d: Syntax error\n", config_file, i);
|
|
exit(1);
|
|
}
|
|
if (pmev(event, &id)) {
|
|
id = strtol(event, NULL, 0);
|
|
}
|
|
if (pmev(equiv, &id_eqv)) {
|
|
id_eqv = strtol(equiv, NULL, 0);
|
|
}
|
|
if (!(table = get_eqv_event(id))) {
|
|
if (eqv_num == APM_MAX_EQUIV_EVENTS - 1) {
|
|
fprintf(stderr, "%s: Too many rules\n", main_argv[0]);
|
|
exit(1);
|
|
}
|
|
table = &eqv_event[eqv_num++];
|
|
table->aee_event = id;
|
|
table->aee_equiv = PMEV_DEFAULT;
|
|
table->aee_resume = PMEV_DEFAULT;
|
|
}
|
|
if (strcasecmp(mode, "default") == 0) {
|
|
mode_type = MODE_DEFAULT;
|
|
}
|
|
else if (strcasecmp(mode, "resume") == 0) {
|
|
mode_type = MODE_RESUME;
|
|
}
|
|
else {
|
|
fprintf(stderr, "%s: %d : Unknown keyword '%s'\n", config_file, i, mode);
|
|
exit(1);
|
|
}
|
|
switch (mode_type) {
|
|
case MODE_DEFAULT:
|
|
table->aee_equiv = table->aee_resume = id_eqv;
|
|
break;
|
|
case MODE_RESUME:
|
|
table->aee_resume = id_eqv;
|
|
break;
|
|
}
|
|
}
|
|
if (verbose) {
|
|
printf("%-14s%-14s%-14s\n", " Original ", " Equivalent ", " After Resume ");
|
|
for (i = 0; i < eqv_num; i++) {
|
|
printf(" 0x%04x ", eqv_event[i].aee_event);
|
|
if (eqv_event[i].aee_equiv != PMEV_DEFAULT) {
|
|
printf(" 0x%04x ", eqv_event[i].aee_equiv);
|
|
}
|
|
else {
|
|
printf(" default ");
|
|
}
|
|
if (eqv_event[i].aee_resume != PMEV_DEFAULT) {
|
|
printf(" 0x%04x ", eqv_event[i].aee_resume);
|
|
}
|
|
else {
|
|
printf(" default ");
|
|
}
|
|
printf("\n");
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
entry_eqv(int dh)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < eqv_num; i++) {
|
|
if (ioctl(dh, APMIO_DEFEQV, &eqv_event[i]) == -1) {
|
|
fprintf(stderr, "%s: Can't ioctl APMIO_DEFEQV.\n", main_argv[0]);
|
|
exit(1);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
flush_eqv(int dh)
|
|
{
|
|
if (ioctl(dh, APMIO_FLUSHEQV, NULL) == -1) {
|
|
fprintf(stderr, "%s: Can't ioctl APMIO_FLUSHBUF.\n", main_argv[0]);
|
|
exit(1);
|
|
}
|
|
}
|
|
|
|
static void
|
|
enable_apm(int dh)
|
|
{
|
|
if (ioctl(dh, APMIO_ENABLE, NULL) == -1) {
|
|
fprintf(stderr, "%s: Can't ioctl APMIO_ENABLE.\n", main_argv[0]);
|
|
exit(1);
|
|
}
|
|
}
|
|
|
|
static void
|
|
disable_apm(int dh)
|
|
{
|
|
if (ioctl(dh, APMIO_DISABLE, NULL) == -1) {
|
|
fprintf(stderr, "%s: Can't ioctl APMIO_DISABLE.\n", main_argv[0]);
|
|
exit(1);
|
|
}
|
|
}
|
|
|
|
static void
|
|
haltcpu_apm(int dh)
|
|
{
|
|
if (ioctl(dh, APMIO_HALTCPU, NULL) == -1) {
|
|
fprintf(stderr, "%s: Can't ioctl APMIO_HALTCPU.\n", main_argv[0]);
|
|
exit(1);
|
|
}
|
|
}
|
|
|
|
static void
|
|
nothaltcpu_apm(int dh)
|
|
{
|
|
if (ioctl(dh, APMIO_NOTHALTCPU, NULL) == -1) {
|
|
fprintf(stderr, "%s: Can't ioctl APMIO_NOTHALTCPU.\n", main_argv[0]);
|
|
exit(1);
|
|
}
|
|
}
|
|
int
|
|
main(int argc, char *argv[])
|
|
{
|
|
int i, dh;
|
|
FILE *fp;
|
|
|
|
main_argc = argc;
|
|
main_argv = argv;
|
|
if ((dh = open(APMDEV, O_RDWR)) == -1) {
|
|
fprintf(stderr, "%s: Can't open '%s'\n", argv[0], APMDEV);
|
|
exit(1);
|
|
}
|
|
parse_option();
|
|
|
|
/* disable operation is executed first */
|
|
if (disable) {
|
|
disable_apm(dh);
|
|
}
|
|
if (init) {
|
|
if (!(fp = fopen(config_file, "r"))) {
|
|
fprintf(stderr, "%s: Can't open config file\n", CONFIGFILE);
|
|
exit(1);
|
|
}
|
|
parse_config_file(fp);
|
|
entry_eqv(dh);
|
|
}
|
|
if (flush) {
|
|
flush_eqv(dh);
|
|
}
|
|
if (haltcpu) {
|
|
haltcpu_apm(dh);
|
|
}
|
|
if (nothaltcpu) {
|
|
nothaltcpu_apm(dh);
|
|
}
|
|
/* enable operation is executed last */
|
|
if (enable) {
|
|
enable_apm(dh);
|
|
}
|
|
return 0;
|
|
}
|