Faugeras' complete motion algorithm implemented using C++