#include <sys/cdefs.h>
#include <stand.h>
#include <string.h>
#include "bootstrap.h"
static int cons_set(struct env_var *ev, int flags, const void *value);
static int cons_find(const char *name);
static int cons_check(const char *string);
static int cons_change(const char *string, char **);
static int twiddle_set(struct env_var *ev, int flags, const void *value);
static int last_input = -1;
int
cons_inputdev(void)
{
int cons;
int flags = C_PRESENTIN | C_ACTIVEIN;
int active = 0;
for (cons = 0; consoles[cons] != NULL; cons++)
if ((consoles[cons]->c_flags & flags) == flags)
active++;
if (active == 1)
return (-1);
return (last_input);
}
uint_t
cons_array_size(void)
{
uint_t n;
if (consoles == NULL)
return (0);
for (n = 0; consoles[n] != NULL; n++)
;
return (n + 1);
}
struct console *
cons_get_console(const char *name)
{
char port[5];
(void) strlcpy(port, name, sizeof (port));
for (uint_t i = 0; consoles[i] != NULL; i++) {
if (strcmp(port, consoles[i]->c_name) == 0)
return (consoles[i]);
}
printf("No such port: %s\n", port);
return (NULL);
}
static void
cons_add_dev(struct console *dev)
{
uint_t c = cons_array_size();
uint_t n = 1;
struct console **tmp;
if (c == 0)
n++;
tmp = realloc(consoles, (c + n) * sizeof (struct console *));
if (tmp == NULL)
return;
if (c > 0)
c--;
consoles = tmp;
consoles[c] = dev;
consoles[c + 1] = NULL;
}
void
cons_probe(void)
{
int cons;
int active;
char *prefconsole, *list, *console;
consoles = NULL;
for (cons = 0;; cons++) {
if (ct_list[cons].ct_dev != NULL) {
cons_add_dev(ct_list[cons].ct_dev);
continue;
}
if (ct_list[cons].ct_init != NULL) {
ct_list[cons].ct_init();
continue;
}
break;
}
(void) env_setenv("twiddle_divisor", EV_VOLATILE, "16", twiddle_set,
env_nounset);
for (cons = 0; consoles[cons] != NULL; cons++) {
consoles[cons]->c_flags = 0;
consoles[cons]->c_probe(consoles[cons]);
}
active = -1;
for (cons = 0; consoles[cons] != NULL; cons++) {
if (consoles[cons]->c_flags == (C_PRESENTIN | C_PRESENTOUT)) {
active = cons;
break;
}
}
if (active == -1)
active = 0;
list = NULL;
prefconsole = getenv("console");
if (prefconsole != NULL)
prefconsole = strdup(prefconsole);
if (prefconsole == NULL)
prefconsole = strdup(consoles[active]->c_name);
unsetenv("console");
cons_change(prefconsole, &list);
printf("Consoles:");
bool first = true;
for (cons = 0; consoles[cons] != NULL; cons++) {
if (consoles[cons]->c_flags & (C_ACTIVEIN | C_ACTIVEOUT)) {
if (first)
first = false;
else
putchar(',');
printf(" %s", consoles[cons]->c_desc);
}
}
printf("\n");
if (list != NULL)
console = list;
else
console = prefconsole;
(void) env_setenv("console", EV_VOLATILE, console, cons_set,
env_nounset);
free(prefconsole);
free(list);
}
void
cons_mode(int raw)
{
int cons;
for (cons = 0; consoles[cons] != NULL; cons++) {
if (raw == 0)
consoles[cons]->c_flags &= ~C_MODERAW;
else
consoles[cons]->c_flags |= C_MODERAW;
}
}
int
getchar(void)
{
int cons;
int flags = C_PRESENTIN | C_ACTIVEIN;
int rv;
for (;;) {
for (cons = 0; consoles[cons] != NULL; cons++) {
if ((consoles[cons]->c_flags & flags) == flags) {
rv = consoles[cons]->c_in(consoles[cons]);
if (rv != -1) {
#ifndef EFI
last_input = cons;
#endif
return (rv);
}
}
}
delay(30 * 1000);
}
}
int
ischar(void)
{
int cons;
for (cons = 0; consoles[cons] != NULL; cons++)
if ((consoles[cons]->c_flags & (C_PRESENTIN | C_ACTIVEIN)) ==
(C_PRESENTIN | C_ACTIVEIN) &&
(consoles[cons]->c_ready(consoles[cons]) != 0))
return (1);
return (0);
}
void
putchar(int c)
{
int cons;
for (cons = 0; consoles[cons] != NULL; cons++)
if ((consoles[cons]->c_flags & (C_PRESENTOUT | C_ACTIVEOUT)) ==
(C_PRESENTOUT | C_ACTIVEOUT)) {
if (c == '\n' &&
(consoles[cons]->c_flags & C_MODERAW) == 0)
consoles[cons]->c_out(consoles[cons], '\r');
consoles[cons]->c_out(consoles[cons], c);
}
}
static int
cons_find(const char *name)
{
int cons;
for (cons = 0; consoles[cons] != NULL; cons++)
if (strcmp(consoles[cons]->c_name, name) == 0)
return (cons);
return (-1);
}
static int
cons_set(struct env_var *ev, int flags, const void *value)
{
int ret;
char *list;
if ((value == NULL) || (cons_check(value) == 0)) {
return (CMD_OK);
}
list = NULL;
ret = cons_change(value, &list);
if (ret != CMD_OK)
return (ret);
if (list != NULL) {
(void) env_setenv(ev->ev_name, flags | EV_NOHOOK, list,
NULL, NULL);
} else {
(void) env_setenv(ev->ev_name, flags | EV_NOHOOK, value,
NULL, NULL);
}
free(list);
return (ret);
}
static int
cons_check(const char *string)
{
int cons, found, failed;
char *curpos, *dup, *next;
dup = next = strdup(string);
found = failed = 0;
while (next != NULL) {
curpos = strsep(&next, " ,");
if (*curpos != '\0') {
cons = cons_find(curpos);
if (cons == -1) {
printf("console %s is invalid!\n", curpos);
failed++;
} else {
if ((consoles[cons]->c_flags &
(C_PRESENTIN | C_PRESENTOUT)) !=
(C_PRESENTIN | C_PRESENTOUT)) {
failed++;
} else
found++;
}
}
}
free(dup);
if (found == 0)
printf("no valid consoles!\n");
if (found == 0 || failed != 0) {
printf("Available consoles:\n");
for (cons = 0; consoles[cons] != NULL; cons++) {
printf(" %s", consoles[cons]->c_name);
if (consoles[cons]->c_devinfo != NULL)
consoles[cons]->c_devinfo(consoles[cons]);
printf("\n");
}
}
return (found);
}
static char *
cons_add_list(char *list, const char *value)
{
char *tmp;
if (list == NULL)
return (strdup(value));
if (asprintf(&tmp, "%s,%s", list, value) > 0) {
free(list);
list = tmp;
}
return (list);
}
static int
cons_change(const char *string, char **list)
{
int cons, active, rv;
char *curpos, *dup, *next;
for (cons = 0; consoles[cons] != NULL; cons++) {
consoles[cons]->c_flags &= ~(C_ACTIVEIN | C_ACTIVEOUT);
}
dup = next = strdup(string);
active = 0;
*list = NULL;
rv = CMD_OK;
while (next != NULL) {
curpos = strsep(&next, " ,");
if (*curpos == '\0')
continue;
cons = cons_find(curpos);
if (cons >= 0) {
consoles[cons]->c_flags |= C_ACTIVEIN | C_ACTIVEOUT;
consoles[cons]->c_init(consoles[cons], 0);
if ((consoles[cons]->c_flags &
(C_ACTIVEIN | C_ACTIVEOUT)) ==
(C_ACTIVEIN | C_ACTIVEOUT)) {
active++;
*list = cons_add_list(*list, curpos);
continue;
}
if (active != 0) {
printf("console %s failed to initialize\n",
consoles[cons]->c_name);
}
}
}
free(dup);
if (active == 0) {
for (cons = 0; consoles[cons] != NULL; cons++) {
consoles[cons]->c_flags |= C_ACTIVEIN | C_ACTIVEOUT;
consoles[cons]->c_init(consoles[cons], 0);
if ((consoles[cons]->c_flags &
(C_ACTIVEIN | C_ACTIVEOUT)) ==
(C_ACTIVEIN | C_ACTIVEOUT)) {
active++;
*list = cons_add_list(*list,
consoles[cons]->c_name);
}
}
if (active == 0)
rv = CMD_ERROR;
}
return (rv);
}
static int
twiddle_set(struct env_var *ev, int flags, const void *value)
{
ulong_t tdiv;
char *eptr;
tdiv = strtoul(value, &eptr, 0);
if (*(const char *)value == 0 || *eptr != 0) {
printf("invalid twiddle_divisor '%s'\n", (const char *)value);
return (CMD_ERROR);
}
twiddle_divisor((uint_t)tdiv);
(void) env_setenv(ev->ev_name, flags | EV_NOHOOK, value, NULL, NULL);
return (CMD_OK);
}
COMMAND_SET(console, "console", "console info", command_console);
static int
command_console(int argc, char *argv[])
{
if (argc > 1)
printf("%s: list info about available consoles\n", argv[0]);
printf("Current console: %s\n", getenv("console"));
printf("Available consoles:\n");
for (int cons = 0; consoles[cons] != NULL; cons++) {
printf(" %s", consoles[cons]->c_name);
if (consoles[cons]->c_devinfo != NULL)
consoles[cons]->c_devinfo(consoles[cons]);
printf("\n");
}
return (CMD_OK);
}