add control law to realign the robot toward the target