Added a couple timeouts and color tracking for visualservo