Improving path planning and mapping based on stereo vision and lidar | IEEE Conference Publication | IEEE Xplore