Mostly implemented embedded architecture

Something in the gait code is throwing outrageous angles periodically.
Something in a recent version of CCS broke UART 2 unlocking, so I'm
using UART5 as the link for now.