Function four_way_four_stage

fn four_way_four_stage(
    map: &Map,
    i: &Intersection,
) -> Option<ControlTrafficSignal>