- Added the full set of terrain-following equations of motion (although
it slows down the code)