Refactor to easy urdf writer construction.