Gravar-mail: Robust Stereo Visual-Inertial Odometry Using Nonlinear Optimization