#include <sys/vt.h> /* for vt_stat */
#include <sys/ioctl.h>
-/* Turn this on to debug init so it won't reboot when killed */
-//#define DEBUG_INIT
-
-#define CONSOLE "/dev/console" /* Logical system console */
-#define VT_PRIMARY "/dev/tty0" /* Primary virtual console */
-#define VT_SECONDARY "/dev/tty1" /* Virtual console */
-#define VT_LOG "/dev/tty2" /* Virtual console */
+#define VT_CONSOLE "/dev/console" /* Logical system console */
+#define VT_PRIMARY "/dev/tty1" /* Primary virtual console */
+#define VT_SECONDARY "/dev/tty2" /* Virtual console */
+#define VT_LOG "/dev/tty3" /* Virtual console */
#define SERIAL_CON0 "/dev/ttyS0" /* Primary serial console */
#define SERIAL_CON1 "/dev/ttyS1" /* Serial console */
#define SHELL "/bin/sh" /* Default shell */
#define INITSCRIPT "/etc/init.d/rcS" /* Initscript. */
#define PATH_DEFAULT "PATH=/usr/local/sbin:/sbin:/bin:/usr/sbin:/usr/bin"
-static char *console = VT_PRIMARY;
-static char *second_terminal = VT_SECONDARY;
-static char *log = "/dev/tty3";
-
+#define LOG 0x1
+#define CONSOLE 0x2
+static char *console = VT_CONSOLE;
+static char *second_console = VT_SECONDARY;
+static char *log = VT_LOG;
+static int kernel_version = 0;
/* try to open up the specified device */
break;
if (fd < 0)
return fd;
- /* Set original flags. */
+ /* Reset original flags. */
if (m != mode)
fcntl(fd, F_SETFL, mode);
return fd;
}
-/* print a message to the specified device */
-void message(char *device, char *fmt, ...)
+/* print a message to the specified device:
+ * device may be bitwise-or'd from LOG | CONSOLE */
+void message(int device, char *fmt, ...)
{
int fd;
+ static int log_fd=-1;
va_list arguments;
- if ((fd = device_open(device, O_WRONLY|O_NOCTTY|O_NDELAY)) >= 0) {
- va_start(arguments, fmt);
- vdprintf(fd, fmt, arguments);
- va_end(arguments);
- close(fd);
- } else {
- fprintf(stderr, "Bummer, can't print: ");
+ /* Take full control of the log tty, and never close it.
+ * It's mine, all mine! Muhahahaha! */
+ if (log_fd==-1) {
+ if ((log_fd = device_open(log, O_RDWR|O_NDELAY)) < 0) {
+ log_fd=-1;
+ fprintf(stderr, "Bummer, can't write to log on %s!\r\n", log);
+ fflush(stderr);
+ return;
+ }
+ }
+
+ if ( (device & LOG) && (log_fd != -1) ) {
va_start(arguments, fmt);
- vfprintf(stderr, fmt, arguments);
- fflush(stderr);
+ vdprintf(log_fd, fmt, arguments);
va_end(arguments);
}
+ if (device & CONSOLE) {
+ if ((fd = device_open(console, O_WRONLY|O_NOCTTY|O_NDELAY)) >= 0) {
+ va_start(arguments, fmt);
+ vdprintf(fd, fmt, arguments);
+ va_end(arguments);
+ close(fd);
+ } else {
+ fprintf(stderr, "Bummer, can't print: ");
+ va_start(arguments, fmt);
+ vfprintf(stderr, fmt, arguments);
+ fflush(stderr);
+ va_end(arguments);
+ }
+ }
}
+
/* Set terminal settings to reasonable defaults */
void set_term( int fd)
{
struct termios tty;
static const char control_characters[] = {
- '\003', '\034', '\177', '\025', '\004', '\0',
+ '\003', '\034', '\177', '\030', '\004', '\0',
'\1', '\0', '\021', '\023', '\032', '\0', '\022',
'\017', '\027', '\026', '\0'
};
tcgetattr(fd, &tty);
+ /* Make it be sane */
+ tty.c_cflag &= CBAUD|CBAUDEX|CSIZE|CSTOPB|PARENB|PARODD;
+ tty.c_cflag |= HUPCL|CLOCAL;
+
/* input modes */
tty.c_iflag = IGNPAR|ICRNL|IXON|IXOFF|IXANY;
const char pattern[] = "MemTotal:";
if ((f = fopen(p, "r")) < 0) {
- message(log, "Error opening %s: %s\n", p, strerror( errno));
+ message(LOG, "Error opening %s: %s\n", p, strerror( errno));
return -1;
}
while (NULL != fgets(s, 79, f)) {
}
#endif
} else {
- console = VT_PRIMARY;
- tried_vtprimary++;
+ console = VT_CONSOLE;
+ tried_devcons++;
}
while ((fd = open(console, O_RDONLY | O_NONBLOCK)) < 0) {
+ /* Can't open selected console -- try /dev/console */
+ if (!tried_devcons) {
+ tried_devcons++;
+ console = VT_CONSOLE;
+ continue;
+ }
/* Can't open selected console -- try vt1 */
if (!tried_vtprimary) {
tried_vtprimary++;
console = VT_PRIMARY;
continue;
}
- /* Can't open selected console -- try /dev/console */
- if (!tried_devcons) {
- tried_devcons++;
- console = CONSOLE;
- continue;
- }
break;
}
if (fd < 0)
console = "/dev/null";
else
close(fd);
- message(log, "console=%s\n", console );
+ message(LOG, "console=%s\n", console );
}
static int waitfor(int pid)
{
int status, wpid;
- message(log, "Waiting for process %d.\n", pid);
+ message(LOG, "Waiting for process %d.\n", pid);
while ((wpid = wait(&status)) != pid) {
if (wpid > 0)
- message(log, "pid %d exited, status=%x.\n", wpid, status);
+ message(LOG, "pid %d exited, status=0x%x.\n", wpid, status);
}
return wpid;
}
signal(SIGTERM, SIG_DFL);
if ((fd = device_open(terminal, O_RDWR)) < 0) {
- message(log, "Bummer, can't open %s\r\n", terminal);
+ message(LOG, "Bummer, can't open %s\r\n", terminal);
exit(-1);
}
dup(fd);
* specifies.
*/
char c;
+ message(LOG, "Waiting for enter to start '%s' (pid %d, console %s)\r\n",
+ *cmd, getpid(), terminal );
write(1, press_enter, sizeof(press_enter) - 1);
read(0, &c, 1);
}
/* Log the process name and args */
- message(log, "Starting pid(%d): '", getpid());
- while ( *cmd) message(log, "%s ", *cmd++);
- message(log, "'\r\n");
+ message(LOG, "Starting pid %d, console %s: '", getpid(), terminal);
+ while ( *cmd) message(LOG, "%s ", *cmd++);
+ message(LOG, "'\r\n");
/* Now run it. The new program will take over this PID,
* so nothing further in init.c should be run. */
execvp(*command, (char**)command+1);
- message(log, "Bummer, could not run '%s'\n", command);
+ message(LOG, "Bummer, could not run '%s'\n", command);
exit(-1);
}
return pid;
struct stat statbuf;
const char* const swap_on_cmd[] =
{ "/bin/swapon", "swapon", "-a", 0};
- const char *no_memory =
- "Sorry, your computer does not have enough memory.\r\n";
if (mem_total() > 3500)
return;
return;
goodnight:
- message(console, "%s", no_memory);
+ message(CONSOLE, "Sorry, your computer does not have enough memory.\r\n");
while (1) sleep(1);
}
const char* const swap_off_cmd[] = { "swapoff", "swapoff", "-a", 0};
const char* const umount_cmd[] = { "umount", "umount", "-a", "-n", 0};
- message(console, "The system is going down NOW !!\r\n");
- sync();
#ifndef DEBUG_INIT
/* Allow Ctrl-Alt-Del to reboot system. */
reboot(RB_ENABLE_CAD);
#endif
+ message(CONSOLE, "The system is going down NOW !!\r\n");
+ sync();
/* Send signals to every process _except_ pid 1 */
- message(console, "Sending SIGHUP to all processes.\r\n");
+ message(CONSOLE, "Sending SIGHUP to all processes.\r\n");
#ifndef DEBUG_INIT
kill(-1, SIGHUP);
#endif
sleep(2);
sync();
- message(console, "Sending SIGKILL to all processes.\r\n");
+ message(CONSOLE, "Sending SIGKILL to all processes.\r\n");
#ifndef DEBUG_INIT
kill(-1, SIGKILL);
#endif
sleep(1);
- waitfor(run( swap_off_cmd, log, FALSE));
- waitfor(run( umount_cmd, log, FALSE));
+ waitfor(run( swap_off_cmd, console, FALSE));
+ waitfor(run( umount_cmd, console, FALSE));
sync();
- if (get_kernel_revision() <= 2 * 65536 + 2 * 256 + 11) {
- /* Removed bdflush call, kupdate in kernels >2.2.11 */
+ if (kernel_version > 0 && kernel_version <= 2 * 65536 + 2 * 256 + 11) {
+ /* bdflush, kupdate not needed for kernels >2.2.11 */
+ message(CONSOLE, "Flushing buffers.\r\n");
bdflush(1, 0);
sync();
}
static void halt_signal(int sig)
{
shutdown_system();
- message(console,
+ message(CONSOLE,
"The system is halted. Press CTRL-ALT-DEL or turn off power\r\n");
+ sync();
#ifndef DEBUG_INIT
- reboot(RB_POWER_OFF);
+ reboot(RB_HALT_SYSTEM);
+ //reboot(RB_POWER_OFF);
#endif
exit(0);
}
static void reboot_signal(int sig)
{
shutdown_system();
- message(console, "Please stand by while rebooting the system.\r\n");
+ message(CONSOLE, "Please stand by while rebooting the system.\r\n");
+ sync();
#ifndef DEBUG_INIT
reboot(RB_AUTOBOOT);
#endif
/* Hello world */
#ifndef DEBUG_INIT
- message(log, hello_msg_format, BB_VER, BB_BT);
- message(console, hello_msg_format, BB_VER, BB_BT);
+ message(CONSOLE|LOG, hello_msg_format, BB_VER, BB_BT);
#else
- message(log, hello_msg_format, getpid(), BB_VER, BB_BT);
- message(console, hello_msg_format, getpid(), BB_VER, BB_BT);
+ message(CONSOLE|LOG, hello_msg_format, getpid(), BB_VER, BB_BT);
#endif
/* Mount /proc */
if (mount ("proc", "/proc", "proc", 0, 0) == 0) {
- message(log, "Mounting /proc: done.\n");
- message(console, "Mounting /proc: done.\n");
- } else {
- message(log, "Mounting /proc: failed!\n");
- message(console, "Mounting /proc: failed!\n");
- }
+ message(CONSOLE|LOG, "Mounting /proc: done.\n");
+ kernel_version = get_kernel_revision();
+ } else
+ message(CONSOLE|LOG, "Mounting /proc: failed!\n");
/* Make sure there is enough memory to do something useful. */
check_memory();
pid1 = run(tty0_commands, console, wait_for_enter);
}
if (pid2 == 0 && tty1_commands) {
- pid2 = run(tty1_commands, second_terminal, TRUE);
+ pid2 = run(tty1_commands, second_console, TRUE);
}
wpid = wait(&status);
if (wpid > 0 ) {
- message(log, "pid %d exited, status=%x.\n", wpid, status);
+ message(LOG, "pid %d exited, status=%x.\n", wpid, status);
}
+ /* Don't respawn init script if it exits */
if (wpid == pid1) {
- pid1 = 0;
- if (run_rc == TRUE) {
- /* Don't respawn init script if it exits. */
+ if (run_rc == FALSE) {
+ pid1 = 0;
+ }
+#if 0
+/* Turn this on to start a shell on the console if the init script exits.... */
+ else {
run_rc=FALSE;
wait_for_enter=TRUE;
tty0_commands=shell_commands;
}
+#endif
}
if (wpid == pid2) {
pid2 = 0;