A control scheme for 5 d.o.f. haptic feedback guided teleoperation