|
| 1 | +#!/usr/bin/env python3 |
| 2 | +""" A script to run REFINE-PLAN on the fake museum simulation example |
| 3 | +
|
| 4 | +Author: Charlie Street |
| 5 | +Owner: Charlie Street |
| 6 | +""" |
| 7 | + |
| 8 | +from refine_plan.models.condition import Label, EqCondition, AndCondition, OrCondition |
| 9 | +from refine_plan.learning.option_learning import mongodb_to_yaml, learn_dbns |
| 10 | +from refine_plan.algorithms.semi_mdp_solver import synthesise_policy |
| 11 | +from refine_plan.models.state_factor import StateFactor |
| 12 | +from refine_plan.models.dbn_option import DBNOption |
| 13 | +from refine_plan.models.semi_mdp import SemiMDP |
| 14 | +from refine_plan.models.state import State |
| 15 | +import sys |
| 16 | + |
| 17 | +# Global map setup |
| 18 | + |
| 19 | +GRAPH = { |
| 20 | + "v1": {"e12": "v2", "e13": "v3", "e14": "v4"}, |
| 21 | + "v2": {"e12": "v1", "e23": "v3", "e25": "v5", "e26": "v6"}, |
| 22 | + "v3": { |
| 23 | + "e13": "v1", |
| 24 | + "e23": "v2", |
| 25 | + "e34": "v4", |
| 26 | + "e35": "v5", |
| 27 | + "e36": "v6", |
| 28 | + "e37": "v7", |
| 29 | + }, |
| 30 | + "v4": {"e14": "v1", "e34": "v3", "e46": "v6", "e47": "v7"}, |
| 31 | + "v5": {"e25": "v2", "e35": "v3", "e56": "v6", "e58": "v8"}, |
| 32 | + "v6": { |
| 33 | + "e26": "v2", |
| 34 | + "e36": "v3", |
| 35 | + "e46": "v4", |
| 36 | + "e56": "v5", |
| 37 | + "e67": "v7", |
| 38 | + "e68": "v8", |
| 39 | + }, |
| 40 | + "v7": { |
| 41 | + "e37": "v3", |
| 42 | + "e47": "v4", |
| 43 | + "e67": "v6", |
| 44 | + "e78": "v8", |
| 45 | + }, |
| 46 | + "v8": {"e58": "v5", "e68": "v6", "e78": "v7"}, |
| 47 | +} |
| 48 | + |
| 49 | +CORRESPONDING_DOOR = { |
| 50 | + "e12": None, |
| 51 | + "e14": None, |
| 52 | + "e58": "v5", |
| 53 | + "e78": "v7", |
| 54 | + "e13": None, |
| 55 | + "e36": "v3", |
| 56 | + "e68": "v6", |
| 57 | + "e25": "v2", |
| 58 | + "e47": "v4", |
| 59 | + "e26": "v2", |
| 60 | + "e35": "v3", |
| 61 | + "e46": "v4", |
| 62 | + "e37": "v3", |
| 63 | + "e23": None, |
| 64 | + "e34": None, |
| 65 | + "e56": None, |
| 66 | + "e67": None, |
| 67 | +} |
| 68 | + |
| 69 | +# Problem Setup |
| 70 | +INITIAL_LOC = "v1" |
| 71 | +GOAL_LOC = "v8" |
| 72 | + |
| 73 | + |
| 74 | +def _get_enabled_cond(sf_list, option): |
| 75 | + """Get the enabled condition for an option. |
| 76 | +
|
| 77 | + Args: |
| 78 | + sf_list: The list of state factors |
| 79 | + option: The option we want the condition for |
| 80 | +
|
| 81 | + Returns: |
| 82 | + The enabled condition for the option |
| 83 | + """ |
| 84 | + sf_dict = {sf.get_name(): sf for sf in sf_list} |
| 85 | + |
| 86 | + door_locs = ["v{}".format(i) for i in range(2, 8)] |
| 87 | + |
| 88 | + if option == "check_door" or option == "open_door": |
| 89 | + enabled_cond = OrCondition() |
| 90 | + door_status = "unknown" if option == "check_door" else "closed" |
| 91 | + for door in door_locs: |
| 92 | + enabled_cond.add_cond( |
| 93 | + AndCondition( |
| 94 | + EqCondition(sf_dict["location"], door), |
| 95 | + EqCondition(sf_dict["{}_door".format(door)], door_status), |
| 96 | + ) |
| 97 | + ) |
| 98 | + return enabled_cond |
| 99 | + else: # edge navigation option |
| 100 | + enabled_cond = OrCondition() |
| 101 | + for node in GRAPH: |
| 102 | + if option in GRAPH[node]: |
| 103 | + enabled_cond.add_cond(EqCondition(sf_dict["location"], node)) |
| 104 | + door = CORRESPONDING_DOOR[option] |
| 105 | + if door != None: |
| 106 | + enabled_cond = AndCondition( |
| 107 | + enabled_cond, EqCondition(sf_dict["{}_door".format(door)], "open") |
| 108 | + ) |
| 109 | + return enabled_cond |
| 110 | + |
| 111 | + |
| 112 | +def write_mongodb_to_yaml(mongo_connection_str): |
| 113 | + """Learn the DBNOptions from the database. |
| 114 | +
|
| 115 | + Args: |
| 116 | + mongo_connection_str: The MongoDB conenction string""" |
| 117 | + |
| 118 | + loc_sf = StateFactor("location", ["v{}".format(i) for i in range(1, 9)]) |
| 119 | + door_sfs = [ |
| 120 | + StateFactor("v2_door", ["unknown", "closed", "open"]), |
| 121 | + StateFactor("v3_door", ["unknown", "closed", "open"]), |
| 122 | + StateFactor("v4_door", ["unknown", "closed", "open"]), |
| 123 | + StateFactor("v5_door", ["unknown", "closed", "open"]), |
| 124 | + StateFactor("v6_door", ["unknown", "closed", "open"]), |
| 125 | + StateFactor("v7_door", ["unknown", "closed", "open"]), |
| 126 | + ] |
| 127 | + |
| 128 | + print("Writing mongo database to yaml file") |
| 129 | + mongodb_to_yaml( |
| 130 | + mongo_connection_str, |
| 131 | + "refine-plan", |
| 132 | + "fake-museum-data", |
| 133 | + [loc_sf] + door_sfs, |
| 134 | + "../data/fake_museum/dataset.yaml", |
| 135 | + ) |
| 136 | + |
| 137 | + |
| 138 | +def learn_options(): |
| 139 | + """Learn the options from the YAML file.""" |
| 140 | + dataset_path = "../data/fake_museum/dataset.yaml" |
| 141 | + output_dir = "../data/fake_museum/" |
| 142 | + |
| 143 | + loc_sf = StateFactor("location", ["v{}".format(i) for i in range(1, 9)]) |
| 144 | + door_sfs = [ |
| 145 | + StateFactor("v2_door", ["unknown", "closed", "open"]), |
| 146 | + StateFactor("v3_door", ["unknown", "closed", "open"]), |
| 147 | + StateFactor("v4_door", ["unknown", "closed", "open"]), |
| 148 | + StateFactor("v5_door", ["unknown", "closed", "open"]), |
| 149 | + StateFactor("v6_door", ["unknown", "closed", "open"]), |
| 150 | + StateFactor("v7_door", ["unknown", "closed", "open"]), |
| 151 | + ] |
| 152 | + |
| 153 | + learn_dbns(dataset_path, output_dir, [loc_sf] + door_sfs) |
| 154 | + |
| 155 | + |
| 156 | +def run_planner(): |
| 157 | + """Run refine-plan and synthesise a BT. |
| 158 | +
|
| 159 | + Returns: |
| 160 | + The refined BT |
| 161 | + """ |
| 162 | + |
| 163 | + loc_sf = StateFactor("location", ["v{}".format(i) for i in range(1, 9)]) |
| 164 | + door_sfs = [ |
| 165 | + StateFactor("v2_door", ["unknown", "closed", "open"]), |
| 166 | + StateFactor("v3_door", ["unknown", "closed", "open"]), |
| 167 | + StateFactor("v4_door", ["unknown", "closed", "open"]), |
| 168 | + StateFactor("v5_door", ["unknown", "closed", "open"]), |
| 169 | + StateFactor("v6_door", ["unknown", "closed", "open"]), |
| 170 | + StateFactor("v7_door", ["unknown", "closed", "open"]), |
| 171 | + ] |
| 172 | + sf_list = [loc_sf] + door_sfs |
| 173 | + |
| 174 | + labels = [Label("goal", EqCondition(loc_sf, "v8"))] |
| 175 | + |
| 176 | + option_names = [ |
| 177 | + "e12", |
| 178 | + "e14", |
| 179 | + "e58", |
| 180 | + "e78", |
| 181 | + "e13", |
| 182 | + "e36", |
| 183 | + "e68", |
| 184 | + "e25", |
| 185 | + "e47", |
| 186 | + "e26", |
| 187 | + "e35", |
| 188 | + "e46", |
| 189 | + "e37", |
| 190 | + "e23", |
| 191 | + "e34", |
| 192 | + "e56", |
| 193 | + "e67", |
| 194 | + "check_door", |
| 195 | + "open_door", |
| 196 | + ] |
| 197 | + |
| 198 | + assert len(set(option_names)) == 19 # Quick safety check |
| 199 | + |
| 200 | + init_state_dict = {sf: "unknown" for sf in door_sfs} |
| 201 | + init_state_dict[loc_sf] = "v1" |
| 202 | + init_state = State(init_state_dict) |
| 203 | + |
| 204 | + option_list = [] |
| 205 | + for option in option_names: |
| 206 | + print("Reading in option: {}".format(option)) |
| 207 | + t_path = "../data/fake_museum/{}_transition.bifxml".format(option) |
| 208 | + r_path = "../data/fake_museum/{}_reward.bifxml".format(option) |
| 209 | + option_list.append( |
| 210 | + DBNOption( |
| 211 | + option, t_path, r_path, sf_list, _get_enabled_cond(sf_list, option) |
| 212 | + ) |
| 213 | + ) |
| 214 | + |
| 215 | + print("Creating MDP...") |
| 216 | + semi_mdp = SemiMDP(sf_list, option_list, labels, initial_state=init_state) |
| 217 | + print("Synthesising Policy...") |
| 218 | + policy = synthesise_policy(semi_mdp, prism_prop='Rmin=?[F "goal"]') |
| 219 | + policy.write_policy("../data/fake_museum/fake_museum_refined_policy.yaml") |
| 220 | + |
| 221 | + |
| 222 | +if __name__ == "__main__": |
| 223 | + |
| 224 | + # write_mongodb_to_yaml(sys.argv[1]) |
| 225 | + # learn_options() |
| 226 | + run_planner() |
0 commit comments