1 # -*- coding: utf-8 -*-
4 from math import cos, pi, sin
5 from plot import load_scenario
12 if __name__ == "__main__":
13 s = load_scenario("{}.json".format(TOLOAD))
17 nx = x * cos(RA) - y * sin(RA)
18 ny = x * sin(RA) + y * cos(RA)
20 ns["init"] = (nx, ny, nh)
23 nx = x * cos(RA) - y * sin(RA)
24 ny = x * sin(RA) + y * cos(RA)
26 ns["goal"] = (nx, ny, nh)
29 ns["slot"]["polygon"] = []
30 for (x, y) in s["slot"]["polygon"]:
31 nx = x * cos(RA) - y * sin(RA)
32 ny = x * sin(RA) + y * cos(RA)
33 ns["slot"]["polygon"].append((nx, ny))
40 for (x, y) in o["segment"]:
41 nx = x * cos(RA) - y * sin(RA)
42 ny = x * sin(RA) + y * cos(RA)
43 no["segment"].append((nx, ny))
48 with open("{}.json".format(SAVEAS), "w") as f: