added SLAM formulation in chapter 2