Added urdf files and fixed openrave related scripts
Added cartesian controller. Needs improvement