More generalized functions
Use cv tracker to follow LEDs; need work on re-registration