Elbow high or low, avoid obstacle collision with redundancy control