Added check_reachability, normalize_angles, forward_kinematics, max_reach, and min_reach functions.