1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142

use rand::prelude::SliceRandom;
use rand::{Rng, SeedableRng};
use rand_xorshift::XorShiftRng;

use abstutil::{prettyprint_usize, Timer};
use geom::{Distance, Duration, FindClosest};
use map_model::{AmenityType, BuildingID, Map};
use sim::{IndividTrip, Scenario, TripEndpoint, TripMode, TripPurpose};

pub fn run(
    input_scenario: String,
    should_add_return_trips: bool,
    should_add_lunch_trips: bool,
    rng_seed: u64,
) {
    let mut rng = XorShiftRng::seed_from_u64(rng_seed);
    let mut timer = Timer::new("augment scenario");

    let mut scenario: Scenario = abstio::must_read_object(input_scenario, &mut timer);
    let map = Map::load_synchronously(scenario.map_name.path(), &mut timer);

    if should_add_return_trips {
        add_return_trips(&mut scenario, &mut rng);
    }
    if should_add_lunch_trips {
        add_lunch_trips(&mut scenario, &map, &mut rng, &mut timer);
    }

    scenario.save();
}

fn add_return_trips(scenario: &mut Scenario, rng: &mut XorShiftRng) {
    let mut cnt = 0;
    for person in &mut scenario.people {
        if person.trips.len() != 1 {
            continue;
        }

        // Assume a uniform distribution of 4-12 hour workday
        let depart =
            person.trips[0].depart + rand_duration(rng, Duration::hours(4), Duration::hours(12));
        person.trips.push(IndividTrip::new(
            depart,
            TripPurpose::Home,
            person.trips[0].destination,
            person.trips[0].origin,
            person.trips[0].mode,
        ));
        cnt += 1;
    }
    info!("Added return trips to {} people", prettyprint_usize(cnt));
}

fn rand_duration(rng: &mut XorShiftRng, low: Duration, high: Duration) -> Duration {
    Duration::seconds(rng.gen_range(low.inner_seconds()..high.inner_seconds()))
}

fn add_lunch_trips(scenario: &mut Scenario, map: &Map, rng: &mut XorShiftRng, timer: &mut Timer) {
    // First let's build up a quadtree of lunch spots.
    timer.start("index lunch spots");
    let mut closest_spots: FindClosest<BuildingID> = FindClosest::new(map.get_bounds());
    for b in map.all_buildings() {
        if b.amenities
            .iter()
            .any(|a| AmenityType::categorize(&a.amenity_type) == Some(AmenityType::Food))
        {
            closest_spots.add(b.id, b.polygon.points());
        }
    }
    timer.stop("index lunch spots");

    timer.start_iter("add lunch trips", scenario.people.len());
    let mut cnt = 0;
    for person in &mut scenario.people {
        timer.next();
        let num_trips = person.trips.len();
        // Only handle people with their final trip going back home.
        if num_trips <= 1 || person.trips[num_trips - 1].destination != person.trips[0].origin {
            continue;
        }

        let work = match person.trips[num_trips - 2].destination {
            TripEndpoint::Bldg(b) => b,
            _ => continue,
        };
        let has_bike = person.trips[num_trips - 2].mode == TripMode::Bike;
        let (restaurant, mode) =
            if let Some(pair) = pick_lunch_spot(work, has_bike, &closest_spots, map, rng) {
                pair
            } else {
                continue;
            };

        // Insert the break in the middle of their workday
        let t1 = person.trips[num_trips - 2].depart;
        let t2 = person.trips[num_trips - 1].depart;
        let depart = t1 + (t2 - t1) / 2.0;
        let return_home = person.trips.pop().unwrap();
        person.trips.push(IndividTrip::new(
            depart,
            TripPurpose::Meal,
            TripEndpoint::Bldg(work),
            TripEndpoint::Bldg(restaurant),
            mode,
        ));
        person.trips.push(IndividTrip::new(
            depart + Duration::minutes(30),
            TripPurpose::Work,
            TripEndpoint::Bldg(restaurant),
            TripEndpoint::Bldg(work),
            mode,
        ));
        person.trips.push(return_home);
        cnt += 1;
    }
    info!("Added lunch trips to {} people", prettyprint_usize(cnt));
}

fn pick_lunch_spot(
    work: BuildingID,
    has_bike: bool,
    closest_spots: &FindClosest<BuildingID>,
    map: &Map,
    rng: &mut XorShiftRng,
) -> Option<(BuildingID, TripMode)> {
    // We have a list of candidate shops and the Euclidean distance there. Use that distance to
    // make a weighted choice.
    let choices =
        closest_spots.all_close_pts(map.get_b(work).polygon.center(), Distance::miles(10.0));
    let (b, _, dist) = choices
        .choose_weighted(rng, |(_, _, dist)| dist.inner_meters())
        .ok()?;
    // Simple hardcoded mode thresholds for now
    let mode = if *dist <= Distance::miles(1.0) {
        TripMode::Walk
    } else if has_bike {
        TripMode::Bike
    } else {
        TripMode::Drive
    };
    Some((*b, mode))
}