Fix >=level3 shoulder flexion and extension algo