Implemented steering trimming in the controller class, works. Also added a directory for testing code.