visual servo control partially implemented. get's stuck in endpoint control loop
endpoint_control uses position controller