In general it would be great if frame_ids and joint_names would be parametrized and if place locations came from a config file