Как в переназначить выходы в Teacup Firmware

Ситуация в следующем: есть шильд CNC V3, там есть два резервных потра A4 И А5, хочу привязать к ним термистор стола и нагреватель на MOSFET, но ни как не могу найти в прошивке где это сделать. В config.h дописал :

/** def TEMP_SENSOR_PIN

Temperature sensor pins a user should be able to choose from in configtool.

All commented out.

*/

//#define TEMP_SENSOR_PIN AIO1

//#define TEMP_SENSOR_PIN AIO2

//#define TEMP_SENSOR_PIN AIO3

//#define TEMP_SENSOR_PIN AIO4

//#define TEMP_SENSOR_PIN AIO5

и дописал :

/** def HEATER_PIN

Heater pins a user should be able to choose from in configtool. All

commented out.

*/

//#define HEATER_PIN AIO2

//#define HEATER_PIN AIO4

//#define HEATER_PIN AIO5

Запускаю configtool, они появились, но не работают. Лезу через Arduino в раздел gcode_process.с и там вижу:

сase 140:

//? --- M140: Set heated bed temperature ---

//? Undocumented.

#ifdef HEATER_BED

if ( ! next_target.seen_S)

break;

temp_set(HEATER_BED, next_target.S);

#endif

break;

Что я делаю не так, помогите пожалуйста. Или я пошел не верным путем?