implemented debugging over uart
re-written RC switch reading
added trivial yaw controller
adjustments in switch handling