Fixed errors with data parsing and fixed logic for robot links
Merge branch 'master' of https://github.com/mrsl/rone