Added trajectory controller
Made mods to commander for AUTO
Made mods for alt hold