MADE:
--> Added more functionality

TODO:
--> GivenRotations
--> QR
--> EKF