Ackermann steering geometry model and basic control in Matlab