2 * Copyright (C) 2013 Felix Fietkau <nbd@openwrt.org>
3 * Copyright (C) 2013 John Crispin <blogic@openwrt.org>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU Lesser General Public License version 2.1
7 * as published by the Free Software Foundation
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
15 #include <sys/types.h>
17 #include <sys/ioctl.h>
26 #include <libubox/utils.h>
27 #include <libubox/list.h>
29 #include "utils/utils.h"
45 void (*cb
) (struct init_action
*a
);
50 struct list_head list
;
56 struct init_handler
*handler
;
57 struct uloop_process proc
;
60 struct uloop_timeout tout
;
63 static const char *tab
= "/etc/inittab";
64 static char *ask
= "/sbin/askfirst";
66 static LIST_HEAD(actions
);
68 static int dev_open(const char *dev
)
74 fd
= open( dev
, O_RDWR
);
81 static int dev_exist(const char *dev
)
93 static void fork_worker(struct init_action
*a
)
102 fd
= dev_open(a
->id
);
105 dup2(fd
, STDIN_FILENO
);
106 dup2(fd
, STDOUT_FILENO
);
107 dup2(fd
, STDERR_FILENO
);
108 if (fd
> STDERR_FILENO
)
112 ioctl(STDIN_FILENO
, TIOCSCTTY
, 1);
113 tcsetpgrp(STDIN_FILENO
, p
);
115 execvp(a
->argv
[0], a
->argv
);
116 ERROR("Failed to execute %s\n", a
->argv
[0]);
120 if (a
->proc
.pid
> 0) {
121 DEBUG(4, "Launched new %s action, pid=%d\n",
124 uloop_process_add(&a
->proc
);
128 static void child_exit(struct uloop_process
*proc
, int ret
)
130 struct init_action
*a
= container_of(proc
, struct init_action
, proc
);
132 DEBUG(4, "pid:%d\n", proc
->pid
);
133 uloop_timeout_set(&a
->tout
, a
->respawn
);
136 static void respawn(struct uloop_timeout
*tout
)
138 struct init_action
*a
= container_of(tout
, struct init_action
, tout
);
142 static void rcdone(struct runqueue
*q
)
147 static void runrc(struct init_action
*a
)
149 if (!a
->argv
[1] || !a
->argv
[2]) {
150 ERROR("valid format is rcS <S|K> <param>\n");
153 rcS(a
->argv
[1], a
->argv
[2], rcdone
);
156 static void askfirst(struct init_action
*a
)
160 if (!dev_exist(a
->id
) || (console
&& !strcmp(console
, a
->id
))) {
161 DEBUG(4, "Skipping %s\n", a
->id
);
165 a
->tout
.cb
= respawn
;
166 for (i
= MAX_ARGS
- 1; i
>= 1; i
--)
167 a
->argv
[i
] = a
->argv
[i
- 1];
171 a
->proc
.cb
= child_exit
;
175 static void askconsole(struct init_action
*a
)
177 char line
[256], *tty
, *split
;
180 tty
= get_cmdline_val("console", line
, sizeof(line
));
182 split
= strchr(tty
, ',');
186 if (!dev_exist(tty
)) {
187 DEBUG(4, "skipping %s\n", tty
);
191 console
= strdup(tty
);
199 a
->tout
.cb
= respawn
;
200 for (i
= MAX_ARGS
- 1; i
>= 1; i
--)
201 a
->argv
[i
] = a
->argv
[i
- 1];
205 a
->proc
.cb
= child_exit
;
209 static void rcrespawn(struct init_action
*a
)
211 a
->tout
.cb
= respawn
;
214 a
->proc
.cb
= child_exit
;
218 static struct init_handler handlers
[] = {
230 .name
= "askconsole",
240 static int add_action(struct init_action
*a
, const char *name
)
244 for (i
= 0; i
< ARRAY_SIZE(handlers
); i
++)
245 if (!strcmp(handlers
[i
].name
, name
)) {
246 a
->handler
= &handlers
[i
];
247 list_add_tail(&a
->list
, &actions
);
250 ERROR("Unknown init handler %s\n", name
);
254 void procd_inittab_run(const char *handler
)
256 struct init_action
*a
;
258 list_for_each_entry(a
, &actions
, list
)
259 if (!strcmp(a
->handler
->name
, handler
)) {
260 if (a
->handler
->multi
) {
269 void procd_inittab(void)
272 FILE *fp
= fopen(tab
, "r");
273 struct init_action
*a
;
275 regmatch_t matches
[5];
279 ERROR("Failed to open %s\n", tab
);
283 regcomp(&pat_inittab
, "([a-zA-Z0-9]*):([a-zA-Z0-9]*):([a-zA-Z0-9]*):(.*)", REG_EXTENDED
);
284 line
= malloc(LINE_LEN
);
285 a
= malloc(sizeof(struct init_action
));
286 memset(a
, 0, sizeof(struct init_action
));
288 while (fgets(line
, LINE_LEN
, fp
)) {
289 char *tags
[TAG_PROCESS
+ 1];
292 int len
= strlen(line
);
294 while (isspace(line
[len
- 1]))
301 if (regexec(&pat_inittab
, line
, 5, matches
, 0))
304 DEBUG(4, "Parsing inittab - %s", line
);
306 for (i
= TAG_ID
; i
<= TAG_PROCESS
; i
++) {
307 line
[matches
[i
].rm_eo
] = '\0';
308 tags
[i
] = &line
[matches
[i
+ 1].rm_so
];
311 tok
= strtok(tags
[TAG_PROCESS
], " ");
312 for (i
= 0; i
< (MAX_ARGS
- 1) && tok
; i
++) {
314 tok
= strtok(NULL
, " ");
317 a
->id
= tags
[TAG_ID
];
320 if (add_action(a
, tags
[TAG_ACTION
]))
322 line
= malloc(LINE_LEN
);
323 a
= malloc(sizeof(struct init_action
));
324 memset(a
, 0, sizeof(struct init_action
));
330 regfree(&pat_inittab
);