fix normalize_angle
work on geometry and behavior