import json
from apf import APF
from rrt import RRT
def load_config(config_filename: str) -> dict:
with open(config_filename) as f:
config = json.load(f)
return config
def pretty_print_config(config: dict):
print(json.dumps(config, indent=2, sort_keys=False))
if __name__ == '__main__':
config = load_config('config.json')
apf_paraboloid = APF(config, paraboloid=True)
apf_paraboloid.apf()
apf_conical = APF(config, paraboloid=False)
apf_conical.apf()
rrt = RRT(config)
rrt.bidirectional_rrt()
