Edited Helper class, added inverseDepthToCartesian function from
monoslam

Added the Camera class being passed around everywhere