#include <sys/cdefs.h>
#ifndef lint
__COPYRIGHT("@(#) Copyright (c) 1996-2002\
The NetBSD Foundation, Inc. All rights reserved.");
__RCSID("$NetBSD: screenblank.c,v 1.29 2011/08/30 20:33:30 joerg Exp $");
#endif
#include <sys/types.h>
#include <sys/time.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <sys/queue.h>
#include <ctype.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#include <limits.h>
#include <math.h>
#include <paths.h>
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <signal.h>
#include <syslog.h>
#include <unistd.h>
#include <util.h>
#include <dev/wscons/wsconsio.h>
#ifdef HAVE_FBIO
#include <dev/sun/fbio.h>
#endif
#include "pathnames.h"
static u_long setvideo = WSDISPLAYIO_SVIDEO;
static int videoon = WSDISPLAYIO_VIDEO_ON;
static int videooff = WSDISPLAYIO_VIDEO_OFF;
struct dev_stat {
LIST_ENTRY(dev_stat) ds_link;
const char *ds_path;
int ds_isfb;
time_t ds_atime;
time_t ds_mtime;
};
static LIST_HEAD(ds_list, dev_stat) ds_list;
static void add_dev(const char *, int);
static void change_state(int);
static void cvt_arg(char *, struct timespec *);
__dead static void sighandler(int);
static int is_graphics_fb(struct dev_stat *);
__dead static void usage(void);
int
main(int argc, char *argv[])
{
struct dev_stat *dsp;
struct timespec timo_on, timo_off, *tvp, tv;
struct sigaction sa;
struct stat st;
int ch, change, fflag = 0, kflag = 0, mflag = 0, state;
int bflag = 0, uflag = 0;
const char *kbd, *mouse, *display;
LIST_INIT(&ds_list);
timo_on.tv_sec = 600;
timo_on.tv_nsec = 0;
timo_off.tv_sec = 0;
timo_off.tv_nsec = 250000000;
while ((ch = getopt(argc, argv, "bd:e:f:i:kmu")) != -1) {
switch (ch) {
case 'b':
bflag = 1;
uflag = 0;
break;
case 'd':
cvt_arg(optarg, &timo_on);
break;
case 'e':
cvt_arg(optarg, &timo_off);
break;
case 'f':
fflag = 1;
add_dev(optarg, 1);
break;
case 'i':
add_dev(optarg, 0);
break;
case 'k':
if (mflag || kflag)
usage();
kflag = 1;
break;
case 'm':
if (kflag || mflag)
usage();
mflag = 1;
break;
case 'u':
uflag = 1;
bflag = 0;
break;
default:
usage();
}
}
argc -= optind;
if (argc)
usage();
kbd = _PATH_WSKBD;
mouse = _PATH_WSMOUSE;
display = _PATH_WSDISPLAY;
#ifdef HAVE_FBIO
if (!fflag) {
int fd;
if ((fd = open(display, O_RDONLY, 0666)) == -1)
setvideo = FBIOSVIDEO;
else
(void) close(fd);
}
if (setvideo == FBIOSVIDEO) {
videoon = FBVIDEO_ON;
videooff = FBVIDEO_OFF;
kbd = _PATH_KEYBOARD;
mouse = _PATH_MOUSE;
display = _PATH_FB;
}
#endif
add_dev(_PATH_CONSOLE, 0);
if (!fflag)
add_dev(display, 1);
if (bflag || uflag) {
change_state(bflag ? videooff : videoon);
exit(0);
}
if (!kflag)
add_dev(kbd, 0);
if (!mflag)
add_dev(mouse, 0);
state = videoon;
change_state(state);
tvp = &timo_on;
sa.sa_handler = sighandler;
sa.sa_flags = SA_NOCLDSTOP;
if (sigemptyset(&sa.sa_mask))
err(1, "sigemptyset");
if (sigaction(SIGINT, &sa, NULL) || sigaction(SIGTERM, &sa, NULL) ||
sigaction(SIGHUP, &sa, NULL))
err(1, "sigaction");
openlog("screenblank", LOG_PID, LOG_DAEMON);
if (daemon(0, 0))
err(1, "daemon");
pidfile(NULL);
for (;;) {
change = 0;
LIST_FOREACH(dsp, &ds_list, ds_link) {
if (is_graphics_fb(dsp))
continue;
if (stat(dsp->ds_path, &st) == -1) {
syslog(LOG_CRIT,
"Can't stat `%s' (%m)", dsp->ds_path);
exit(1);
}
if (st.st_atime > dsp->ds_atime) {
change = 1;
dsp->ds_atime = st.st_atime;
}
if (st.st_mtime > dsp->ds_mtime) {
change = 1;
dsp->ds_mtime = st.st_mtime;
}
}
if (state == videoon) {
if (!change) {
state = videooff;
change_state(state);
tvp = &timo_off;
}
} else {
if (change) {
state = videoon;
change_state(state);
tvp = &timo_on;
}
}
tv = *tvp;
if (nanosleep(&tv, NULL) == -1)
err(1, "nanosleep");
}
}
static void
add_dev(const char *path, int isfb)
{
struct dev_stat *dsp;
struct stat sb;
if (stat(path, &sb) == -1) {
warn("Can't stat `%s'", path);
return;
}
#ifdef HAVE_FBIO
if (isfb && setvideo != FBIOSVIDEO) {
int onoff, fd;
if ((fd = open(path, O_RDWR, 0666)) == -1) {
warn("Can't open `%s'", path);
return;
}
if ((ioctl(fd, FBIOGVIDEO, &onoff)) == 0)
setvideo = FBIOSVIDEO;
(void)close(fd);
}
#endif
dsp = malloc(sizeof(struct dev_stat));
if (dsp == NULL)
err(1, "Can't allocate memory for `%s'", path);
(void)memset(dsp, 0, sizeof(struct dev_stat));
dsp->ds_path = path;
dsp->ds_isfb = isfb;
LIST_INSERT_HEAD(&ds_list, dsp, ds_link);
}
static void
sighandler(int sig)
{
change_state(videoon);
exit(0);
}
static int
is_graphics_fb(struct dev_stat *dsp)
{
int fd;
int state;
if (dsp->ds_isfb == 0)
return 0;
if (setvideo != WSDISPLAYIO_SVIDEO)
return 1;
if ((fd = open(dsp->ds_path, O_RDWR, 0)) == -1) {
syslog(LOG_WARNING, "Cannot open `%s' (%m)", dsp->ds_path);
return 1;
}
if (ioctl(fd, WSDISPLAYIO_GMODE, &state) == -1) {
syslog(LOG_WARNING, "Cannot get mode on `%s' (%m)",
dsp->ds_path);
state = WSDISPLAYIO_MODE_MAPPED;
}
(void)close(fd);
return state != WSDISPLAYIO_MODE_EMUL;
}
static void
change_state(int state)
{
struct dev_stat *dsp;
int fd;
int fail = 1;
LIST_FOREACH(dsp, &ds_list, ds_link) {
if (dsp->ds_isfb == 0)
continue;
if ((fd = open(dsp->ds_path, O_RDWR, 0)) == -1) {
syslog(LOG_WARNING, "Can't open `%s' (%m)",
dsp->ds_path);
continue;
}
if (ioctl(fd, setvideo, &state) == -1)
syslog(LOG_WARNING, "Can't set video on `%s' (%m)",
dsp->ds_path);
else
fail = 0;
(void)close(fd);
}
if (fail) {
syslog(LOG_CRIT, "No frame buffer devices, exiting\n");
exit(1);
}
}
static void
cvt_arg(char *arg, struct timespec *tvp)
{
char *cp;
int seconds, nanoseconds, factor;
int period = 0;
factor = 1000000000;
nanoseconds = 0;
seconds = 0;
for (cp = arg; *cp != '\0'; ++cp) {
if (*cp == '.') {
if (period)
errx(1, "Invalid argument: %s", arg);
period = 1;
continue;
}
if (!isdigit((unsigned char)*cp))
errx(1, "Invalid argument: %s", arg);
if (period) {
if (factor > 1) {
nanoseconds = nanoseconds * 10 + (*cp - '0');
factor /= 10;
}
} else
seconds = (seconds * 10) + (*cp - '0');
}
tvp->tv_sec = seconds;
if (factor > 1)
nanoseconds *= factor;
tvp->tv_nsec = nanoseconds;
}
static void
usage(void)
{
(void)fprintf(stderr,
"usage: %s [-k | -m] [-d inactivity-timeout] [-e wakeup-delay]\n"
"\t\t[-f framebuffer] [-i input-device]\n"
" %s {-b | -u}\n",
getprogname(),
getprogname());
exit(1);
}