fixed failer by theta3, theta4 and theta5. add function for selection the fast configuration