Stereo Vision Based Three Dimensional Simultaneous Localisation And Mapping