The autopilot should update it's state better now.
Made some major changes to the code. It should be easier to add more features to the framework.