diff --git a/src/modules/px4iofirmware/protocol.h b/src/modules/px4iofirmware/protocol.h
index 717a89a753..f95313e14a 100644
--- a/src/modules/px4iofirmware/protocol.h
+++ b/src/modules/px4iofirmware/protocol.h
@@ -242,12 +242,12 @@ enum {							/* DSM bind states */
 
 #define PX4IO_P_SETUP_SBUS_RATE			22	/* frame rate of SBUS1 output in Hz */
 
-#define PX4IO_P_SETUP_MOTOR_SLEW_MAX 	24 	/* max motor slew rate */
+#define PX4IO_P_SETUP_MOTOR_SLEW_MAX		24 	/* max motor slew rate */
 
 #define PX4IO_P_SETUP_THERMAL			25	/* thermal management */
 #define PX4IO_THERMAL_IGNORE			UINT16_MAX
-#define PX4IO_THERMAL_OFF				0
-#define PX4IO_THERMAL_FULL				10000
+#define PX4IO_THERMAL_OFF			0
+#define PX4IO_THERMAL_FULL			10000
 
 /* autopilot control values, -10000..10000 */
 #define PX4IO_PAGE_CONTROLS			51	/**< actuator control groups, one after the other, 8 wide */
diff --git a/src/modules/px4iofirmware/registers.c b/src/modules/px4iofirmware/registers.c
index ee1473bb27..119f2c2141 100644
--- a/src/modules/px4iofirmware/registers.c
+++ b/src/modules/px4iofirmware/registers.c
@@ -687,16 +687,19 @@ registers_set_one(uint8_t page, uint8_t offset, uint16_t value)
 		case PX4IO_P_SETUP_SCALE_ROLL:
 		case PX4IO_P_SETUP_SCALE_PITCH:
 		case PX4IO_P_SETUP_SCALE_YAW:
-		case PX4IO_P_SETUP_MOTOR_SLEW_MAX:
-
-			r_page_setup[offset] = value;
-			break;
-
 		case PX4IO_P_SETUP_SBUS_RATE:
 			r_page_setup[offset] = value;
 			sbus1_set_output_rate_hz(value);
 			break;
 
+		case PX4IO_P_SETUP_MOTOR_SLEW_MAX:
+			r_page_setup[offset] = value;
+			break;
+
+		case PX4IO_P_SETUP_THERMAL:
+			r_page_setup[PX4IO_P_SETUP_THERMAL] = value;
+			break;
+
 		default:
 			return -1;
 		}