Fusion of vision, GPS and 3D gyro data in solving camera registration problem for direct visual navigation