Fixed priorities for peripheral functions so that short, critical code (I2C, UART RX) cannot be preempted by low priority processes (pid, UART TX). Fixed issue where UART RX killed encoders, and address error on high UART RX.