abawo/pico-sdk
3
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fix list management in stdio_set_driver_enabled so drivers can be freely added and removed (#822)

Browse Source
This commit is contained in:
Graham Sanderson 2022-05-11 10:44:41 -05:00 committed by GitHub
parent 04c68c554b
commit 60a6fea534
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 6 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
src/rp2_common/pico_stdio/stdio.c
View File

@ -180,20 +180,19 @@ int _write(int handle, char *buffer, int length) {
}
void stdio_set_driver_enabled(stdio_driver_t *driver, bool enable) {
stdio_driver_t *prev = drivers;
for (stdio_driver_t *d = drivers; d; d = d->next) {
if (d == driver) {
stdio_driver_t **prev = &drivers;
while (*prev) {
if (*prev == driver) {
if (!enable) {
prev->next = d->next;
*prev = driver->next;
driver->next = NULL;
}
return;
}
prev = d;
prev = &(*prev)->next;
}
if (enable) {
if (prev) prev->next = driver;
else drivers = driver;
*prev = driver;
}
}