6.4.1 考虑加速度的正向运动学