diff --git a/src/modules/px4iofirmware/registers.c b/src/modules/px4iofirmware/registers.c
index 3bcf3968a7..6f1341c347 100644
--- a/src/modules/px4iofirmware/registers.c
+++ b/src/modules/px4iofirmware/registers.c
@@ -630,6 +630,12 @@ registers_set_one(uint8_t page, uint8_t offset, uint16_t value)
 			r_page_setup[PX4IO_P_SETUP_PWM_REVERSE] = value;
 			break;
 
+		case PX4IO_P_SETUP_TRIM_ROLL:
+		case PX4IO_P_SETUP_TRIM_PITCH:
+		case PX4IO_P_SETUP_TRIM_YAW:
+			r_page_setup[offset] = value;
+			break;
+
 		default:
 			return -1;
 		}