摘自 "Robust Optimization for Simultaneous Localization and Mapping Niko Sunderhauf (PhD thesis) 2012"第22页。
