Latest working VicsWagon code for iARoC 2014