Bug in motion model #2
Description
Hi, Shuhui
You mentioned the performance is worse than the Matlab version. The reason might be a bug in motion model. In FastSLAM2_Thread::predict(), sin(G/WB) should be corrected to sin(G)/WB. The bug is inherited from yglee"s implementation.
Fan