Code
SLAM simulations
In the link below you can find Matlab code for EKF-SLAM simulations that I prepared with Tim Bailey. Tim also wrote simulations Matlab code for FastSLAM and UKF-SLAM.
Multi-modal registration of range and image data
My student Zachary published his code for multi-modal registration. In the link below you will find the matlab code plus a reference paper.