Some 3D vision algorithms
The folder Calibration contains algorithms to calibration the camera focal view from vanishing points.
The folder Pose_Manipulation contains code to interpolation between poses. This is done using spherical linear interpolation (SLERP) for the orientation and linear interpolation for the position.
The folder Numerical_Optimization contains different algorithms for unconstrained non-linear minimization. For example, gradient descent or conjugate gradient.