add model 4 in simulator and change KNOW_POS_TOL = 2