Re-factored the way objects are removed from scene.
Fixed Moving/TurnedToward conditions.
Implemented all mathematical functions.