added calculate_ik_score.m and related from KJK
theta1 preliminary solutions for left and right arm positions