Online Lidar and Vision based Ego-motion Estimation and Mapping