Tree association integrated and tested. Stop and Go motion model also reimplemented and odometry syntetic noise added per particle