wip
Reconstruction moved to chilitags -> much simpler ROS code