Added LCD to transmitter, refactor attitude calculations