This is the draft for the paper for RA-L and IROS
This project is to use only range information(UDB hardware) to localize all robots in a swarm.