I added the nextStep method to PhysicalCalculator and I give an infinity mass to the box in front of the robot in the test (0) .