Robot force/position control with force and visual feedback