Real-time 3D Stereo Mapping in Complex Dynamic Environments