diff --git a/lib/io/src/i2c.rs b/lib/io/src/i2c.rs
index 6f5ed61..211936e 100644
--- a/lib/io/src/i2c.rs
+++ b/lib/io/src/i2c.rs
@@ -33,7 +33,7 @@ pub mod mock_i2c {
     use heapless::FnvIndexMap;
 
     /// A fixed-size map of I2C values, indexed by device address and register address
-    type I2cValues = FnvIndexMap<(u8, u16), Option<u8>, 32>;
+    type I2cValues = FnvIndexMap<(u8, u16), Option<u8>, 40>;
 
     /// A mock I2C instance which can be used for testing
     pub struct MockI2c {