[enhancement] Implemented measure tool and added to default.rviz. Closes #141.