2.2　系统建模

首先对整个系统建模。该模型主要分为两部分：运动模型和观测模型。