Force control and collision avoidance strategies for kinematically redundant manipulators