Robofocus working
RoboFocus implemented. Needs testing