Fix the bug of cross-correlation coefficient computing in p42; Add p51 to visualize the cross-correlation on EKF demo.