Feature/rdl 114

Removed need for Vector3d_X class that was the result of poor code organization. Reorganized a few things and some code clean up.

Also bumping version to 2.0.0 and releases from this point forward will target melodic or further as this breaks backwards compatability