Edit chapter2 and chapter5

Chapter 2, added citation for EKF consistency definition
chapter 5: added text for introduction before showing convergence figure