Added deriviative. Adjusted attitude.