2 * Acess2 System Init Task
12 #define DEFAULT_SHELL "/Acess/SBin/login"
13 #define INITTAB_FILE "/Acess/Conf/inittab"
15 #define ARRAY_SIZE(x) ((sizeof(x))/(sizeof((x)[0])))
18 int ProcessInittab(const char *Path);
19 char *ReadQuotedString(FILE *FP);
20 char **ReadCommand(FILE *FP);
21 void FreeCommand(char **Command);
23 tInitProgram *AllocateProgram(char **Command, enum eProgType Type, size_t ExtraSpace);
24 void RespawnProgam(tInitProgram *Program);
26 int AddKTerminal(int TerminalSpec, char **Command);
27 int AddSerialTerminal(const char *DevPathSegment, const char *ModeStr, char **Command);
28 int AddDaemon(char *StdoutPath, char *StderrPath, char **Command);
30 int SpawnCommand(int c_stdin, int c_stdout, int c_stderr, char **ArgV, const char **EnvP);
31 int SpawnKTerm(tInitProgram *Program);
32 int SpawnSTerm(tInitProgram *Program);
33 int SpawnDaemon(tInitProgram *Program);
36 const char *gsInittabPath = INITTAB_FILE;
37 tInitProgram *gpInitPrograms;
41 * \fn int main(int argc, char *argv[])
44 int main(int argc, char *argv[])
46 // Parse commandline args
49 // TODO: Behave differently if not invoked as first process?
52 if( ProcessInittab(gsInittabPath) != 0 )
54 // No inittab file found, default to:
55 _SysDebug("inittab '%s' is invalid, falling back to one VT", gsInittabPath);
60 char *args[] = {DEFAULT_SHELL, NULL};
61 const char *env[] = {"TERM=screen", NULL};
62 int pid = SpawnCommand(0, 1, 1, args, env);
63 // TODO: Detect errors
64 _SysWaitTID(pid, NULL);
71 // TODO: Implement message watching
75 pid = _SysWaitTID(-1, &status);
76 _SysDebug("PID %i died, looking for respawn entry", pid);
82 char *ReadQuotedString(FILE *FP)
86 while( isblank(ch = fgetc(FP)) )
95 int pos = 0, space = 0;
96 for( ; !feof(FP); ch = fgetc(FP) )
101 // Add escaped/special character
108 fseek(FP, -1, SEEK_CUR);
111 else if( ch == '\\' )
122 // Double-quoted string
127 else if( ch == '\\' )
134 // Single-quoted string
139 else if( ch == '\\' )
151 void *tmp = realloc(retstr, space+1);
153 _SysDebug("ReadQuotedString - realloc(%i) failure", space+1);
167 char **ReadCommand(FILE *FP)
171 char **ret = malloc(space*sizeof(char*));
174 arg = ReadQuotedString(FP);
177 if( pos == space - 1 ) {
178 _SysDebug("Too many arguments %i", pos);
184 } while(arg != NULL);
195 void FreeCommand(char **Command)
198 while( Command[pos] )
206 int ProcessInittab(const char *Path)
209 FILE *fp = fopen(Path, "r");
221 if( (rv = fscanf(fp, "%64s%*[ \t]", cmdbuf)) != 1 ) {
222 _SysDebug("fscanf rv %i != exp 1", rv);
227 if( cmdbuf[0] == '#' ) {
228 while( !feof(fp) && fgetc(fp) != '\n' )
232 if( cmdbuf[0] == '\0' ) {
234 if( ch != '\n' && ch != -1 ) {
236 _SysDebug("Unexpected char 0x%x, expecting EOL", ch);
237 return 2; // Unexpected character?
243 if( strcmp(cmdbuf, "ktty") == 0 ) {
244 // ktty <ID> <command...>
245 // - Spins off a console on the specified kernel TTY
247 if( fscanf(fp, "%d ", &id) != 1 ) {
248 _SysDebug("init[ktty] - TTY ID read failed");
251 char **command = ReadCommand(fp);
253 _SysDebug("init[ktty] - Command read failure");
256 AddKTerminal(id, command);
258 else if(strcmp(cmdbuf, "stty") == 0 ) {
259 // stty <devpath> [78][NOE][012][bB]<baud> <command...>
261 char modespec[4+6+1];
262 if( fscanf(fp, "%32s %10s ", path_seg, modespec) != 2 ) {
265 char **command = ReadCommand(fp);
268 AddSerialTerminal(path_seg, modespec, command);
270 else if(strcmp(cmdbuf, "daemon") == 0 ) {
271 // daemon <stdout> <stderr> <command...>
272 // - Runs a daemon (respawning) that logs to the specified files
273 // - Will append a header whenever the daemon starts
274 char *stdout_path = ReadQuotedString(fp);
277 char *stderr_path = ReadQuotedString(fp);
280 char **command = ReadCommand(fp);
284 AddDaemon(stdout_path, stderr_path, command);
286 else if(strcmp(cmdbuf, "exec") == 0 ) {
288 // - Runs a command and waits for it to complete before continuing
289 // - NOTE: No other commands will respawn while this is running
290 char **command = ReadCommand(fp);
294 int handles[] = {0, 1, 1};
295 int pid = _SysSpawn(command[0], (const char **)command, NULL, 3, handles, NULL);
297 _SysWaitTID(pid, &retstatus);
298 _SysDebug("Command '%s' returned %i", command[0], retstatus);
300 FreeCommand(command);
304 _SysDebug("Unknown command '%s'", cmdbuf);
310 _SysDebug("label lineError: goto'd - line %i, cmdbuf='%s'", line_num, cmdbuf);
311 while( !feof(fp) && fgetc(fp) != '\n' )
318 if( gpInitPrograms == NULL )
324 tInitProgram *AllocateProgram(char **Command, enum eProgType Type, size_t ExtraSpace)
328 ret = malloc( sizeof(tInitProgram) - sizeof(union uProgTypes) + ExtraSpace );
332 ret->Command = Command;
335 ret->Next = gpInitPrograms;
336 gpInitPrograms = ret;
341 void RespawnProgam(tInitProgram *Program)
344 switch(Program->Type)
346 case PT_KTERM: rv = SpawnKTerm(Program); break;
347 case PT_STERM: rv = SpawnSTerm(Program); break;
348 case PT_DAEMON: rv = SpawnDaemon(Program); break;
350 _SysDebug("BUGCHECK - Program Type %i unknown", Program->Type);
354 _SysDebug("Respawn failure!");
355 // TODO: Remove from list?
359 int AddKTerminal(int TerminalID, char **Command)
361 // TODO: Smarter validation
362 if( TerminalID < 0 || TerminalID > 7 )
365 tInitProgram *ent = AllocateProgram(Command, PT_KTERM, sizeof(struct sKTerm));
366 ent->TypeInfo.KTerm.ID = TerminalID;
372 int AddSerialTerminal(const char *DevPathSegment, const char *ModeStr, char **Command)
374 char dbit, parity, sbit;
378 if( sscanf(ModeStr, "%1[78]%1[NOE]%1[012]%*1[bB]%d", &dbit, &parity, &sbit, &baud) != 4 ) {
380 _SysDebug("Serial mode string is invalid ('%s')", ModeStr);
384 // Validate baud rate / build mode word
385 // TODO: Does baud rate need validation?
386 uint32_t modeword = 0;
387 modeword |= (dbit == '7' ? 1 : 0) << 0;
388 modeword |= (parity == 'O' ? 1 : (parity == 'E' ? 2 : 0)) << 1;
389 modeword |= (sbit - '0') << 3;
392 const char DEVPREFIX[] = "/Devices/pts/serial";
393 int pathlen = sizeof(DEVPREFIX) + strlen(DevPathSegment);
394 tInitProgram *ent = AllocateProgram(Command, PT_STERM, sizeof(struct sSTerm)+pathlen);
395 ent->TypeInfo.STerm.FormatBits = modeword;
396 ent->TypeInfo.STerm.BaudRate = baud;
397 strcpy(ent->TypeInfo.STerm.Path, DEVPREFIX);
398 strcat(ent->TypeInfo.STerm.Path, DevPathSegment);
404 int AddDaemon(char *StdoutPath, char *StderrPath, char **Command)
406 tInitProgram *ent = AllocateProgram(Command, PT_DAEMON, sizeof(struct sDaemon));
407 ent->TypeInfo.Daemon.StdoutPath = StdoutPath;
408 ent->TypeInfo.Daemon.StderrPath = StderrPath;
414 int SpawnCommand(int c_stdin, int c_stdout, int c_stderr, char **ArgV, const char **EnvP)
416 int handles[] = {c_stdin, c_stdout, c_stderr};
418 _SysDebug("Spawning '%s'", ArgV[0]);
421 _SysDebug("SpawnCommand: stdin is invalid");
425 _SysDebug("SpawnCommand: stdout is invalid");
429 _SysDebug("SpawnCommand: stderr is invalid");
433 int rv = _SysSpawn(ArgV[0], (const char **)ArgV, EnvP, 3, handles, NULL);
436 if( c_stdout != c_stdin )
438 if( c_stderr != c_stdin && c_stderr != c_stdout )
444 int SpawnKTerm(tInitProgram *Program)
446 const char fmt[] = "/Devices/pts/vt%i";
447 const char *env[] = {"TERM=screen", NULL};
448 char path[sizeof(fmt)];
450 snprintf(path, sizeof(path), fmt, Program->TypeInfo.KTerm.ID);
452 int in = _SysOpen(path, OPENFLAG_READ);
453 int out = _SysOpen(path, OPENFLAG_WRITE);
455 _SysDebug("Spawning virtual terminal '%s' with term '%s'",
456 path, Program->Command[0]);
457 return SpawnCommand(in, out, out, Program->Command, env);
460 int SpawnSTerm(tInitProgram *Program)
462 int in = _SysOpen(Program->TypeInfo.STerm.Path, OPENFLAG_READ);
463 int out = _SysOpen(Program->TypeInfo.STerm.Path, OPENFLAG_WRITE);
465 if(in == -1 || out == -1 ) {
466 _SysDebug("Unable to open serial port '%s'", Program->TypeInfo.STerm.Path);
471 if( _SysIOCtl(in, 0, NULL) != DRV_TYPE_SERIAL )
476 _SysIOCtl(in, SERIAL_IOCTL_GETSETBAUD, &Program->TypeInfo.STerm.BaudRate);
477 _SysIOCtl(in, SERIAL_IOCTL_GETSETFORMAT, &Program->TypeInfo.STerm.FormatBits);
480 _SysDebug("Spawning serial terminal '%s' with term '%s'",
481 Program->TypeInfo.STerm.Path, Program->Command[0]);
482 return SpawnCommand(in, out, out, Program->Command, NULL);
485 int SpawnDaemon(tInitProgram *Program)
487 int in = _SysOpen("/Devices/null", OPENFLAG_READ);
488 int out = _SysOpen(Program->TypeInfo.Daemon.StdoutPath, OPENFLAG_WRITE);
489 int err = _SysOpen(Program->TypeInfo.Daemon.StderrPath, OPENFLAG_WRITE);
491 if( in < 0 || out < 0 || err < 0 ) {
492 perror("SpawnDaemon");
502 size_t len = snprintf(buffer, 100, "[%lli] init spawning ", _SysTimestamp());
503 _SysWrite(out, buffer, len);
504 for( int i = 0; Program->Command[i]; i ++ )
506 _SysWrite(out, "'", 1);
507 _SysWrite(out, Program->Command[i], strlen(Program->Command[i]));
508 _SysWrite(out, "'", 1);
510 _SysWrite(out, "\n", 1);
513 return SpawnCommand(in, out, err, Program->Command, NULL);