step functions and real hardware working with gridslam