A Simultaneous Localisation and Mapping simulation in MATLAB