Add method for vector rotation for converting to world coordinate system

Implement and test a method to rotate a given vector of the image coordinate system to match the world coordinate system with regard to extrinsic calibration.

When implementing the orientation of aruco markers, the detected vector has to be rotated to match up with the extrinsic calibration. There is no method to do this currently and for better reviewing this gets its own issue.