updated location of basik_ik header file
clean up basic_kin
Added missing weighting to goal_position