IOMUX: Introduce iomux_replace_device()

Some console devices may appear or disappear at run time. In order to
support such a hotplug mechanism introduce a new iomux_replace_device()
helper to update the list of devices without altering environment.

Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
This commit is contained in:
Andy Shevchenko 2021-02-11 17:09:43 +02:00 committed by Tom Rini
parent 400797cad3
commit 694cd5618c
2 changed files with 34 additions and 0 deletions

View file

@ -139,4 +139,37 @@ int iomux_doenv(const int console, const char *arg)
free(old_set);
return 0;
}
int iomux_replace_device(const int console, const char *old, const char *new)
{
struct stdio_dev *dev;
char *arg = NULL; /* Initial empty list */
int size = 1; /* For NUL terminator */
int i, ret;
for_each_console_dev(i, console, dev) {
const char *name = strcmp(dev->name, old) ? dev->name : new;
char *tmp;
/* Append name with a ',' (comma) separator */
tmp = realloc(arg, size + strlen(name) + 1);
if (!tmp) {
free(arg);
return -ENOMEM;
}
strcat(tmp, ",");
strcat(tmp, name);
arg = tmp;
size = strlen(tmp) + 1;
}
ret = iomux_doenv(console, arg);
if (ret)
ret = -EINVAL;
free(arg);
return ret;
}
#endif /* CONSOLE_MUX */

View file

@ -31,6 +31,7 @@ extern int cd_count[MAX_FILES];
int iomux_match_device(struct stdio_dev **, const int, struct stdio_dev *);
int iomux_doenv(const int, const char *);
int iomux_replace_device(const int, const char *, const char *);
void iomux_printdevs(const int);
#endif /* _IO_MUX_H */