diff options
| author | Andy Shevchenko <andriy.shevchenko@linux.intel.com> | 2020-12-21 14:30:08 +0200 |
|---|---|---|
| committer | Tom Rini <trini@konsulko.com> | 2021-01-15 14:38:00 -0500 |
| commit | 70c2525c0d3c5b459ba5a438b23056be648a5249 (patch) | |
| tree | 567b0892b4803dd3cd3c807b4fbdf08ec2e6047b /common | |
| parent | 420782c45b992c55201ee43426dcae2ffd9807a4 (diff) | |
| download | u-boot-70c2525c0d3c5b459ba5a438b23056be648a5249.tar.gz | |
IOMUX: Stop dropped consoles
When at some point environment shrinks we need to stop dropped devices.
Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
Reviewed-by: Simon Glass <sjg@chromium.org>
Diffstat (limited to 'common')
| -rw-r--r-- | common/iomux.c | 19 |
1 files changed, 16 insertions, 3 deletions
diff --git a/common/iomux.c b/common/iomux.c index 126d92ce85..15bf533885 100644 --- a/common/iomux.c +++ b/common/iomux.c @@ -27,8 +27,8 @@ int iomux_doenv(const int console, const char *arg) { char *console_args, *temp, **start; int i, j, k, io_flag, cs_idx, repeat; + struct stdio_dev **cons_set, **old_set; struct stdio_dev *dev; - struct stdio_dev **cons_set; console_args = strdup(arg); if (console_args == NULL) @@ -128,10 +128,23 @@ int iomux_doenv(const int console, const char *arg) return 1; } - /* Works even if console_devices[console] is NULL. */ - free(console_devices[console]); + old_set = console_devices[console]; + repeat = cd_count[console]; + console_devices[console] = cons_set; cd_count[console] = cs_idx; + + /* Stop dropped consoles */ + for (i = 0; i < repeat; i++) { + for (j = 0; j < cs_idx; j++) { + if (old_set[i] == cons_set[j]) + break; + } + if (j == cs_idx) + console_stop(console, old_set[i]); + } + + free(old_set); return 0; } #endif /* CONSOLE_MUX */ |