function final_pos = draw_angle_segment(segment_length, curr_pos, angle)
    modified_angle = -angle;%-angle keep this for the 90 deg case
    final_pos = [curr_pos(1)+(segment_length*cosd(modified_angle)) curr_pos(2)+(segment_length*sind(modified_angle))];
    plot([curr_pos(1) final_pos(1)],[curr_pos(2) final_pos(2)],'-r');
    drawnow
    hold on
end