added Mars and Saturn orbital compensator to heading control.
Using minimize energy function