A new mobile robot toolbox for matlab