Add MjAPI.getEnergyStored()