navigation, USART for communications, twi fixes and EVERYTHING
Navigation and small TWI fixes