Modified version of Ardusim for nus_boxslam