Visual Inertial SLAM using EKF