DiSlord improvements

ChibiOS

@@ -1 +1 @@
-Subproject commit 669d4bbc8da1ee0e4ccdf93a472b06d183922320
+Subproject commit ade76dea89cd093650552328e881252a06486094

ili9341.c

@@ -323,6 +323,7 @@ void spi_init(void)
 static uint16_t current_spi_mode;
 void set_SPI_mode(uint16_t mode){
   if (current_spi_mode == mode) return;
+  dmaChannelWaitCompletionRxTx();
   // Disable current mode
   switch(current_spi_mode){
     case SPI_MODE_LCD:

main.c

@@ -2182,8 +2182,11 @@ void shell_reset_console(void){
       sduConfigureHookI(&SDU1);
   }
   // Reset I/O queue over Serial
-  oqResetI(&SD1.oqueue);
+//  oqResetI(&SD1.oqueue);
-  iqResetI(&SD1.iqueue);
+//  iqResetI(&SD1.iqueue);
+  qResetI(&SD1.oqueue);
+  qResetI(&SD1.iqueue);
+
 }