Added timing functions, waypoint timers (temporary physics fix)