Structured code. Added more logic for moving animal. Renamed some methods.
Added more logic for updating attitude and position
Merge conflicts