A hybrid filtering and maximum likelihood approach to SLAM