RURAMPS 4D, Marline и сервопривод

Доброго времени суток! Дано:RURAMPS 4D 1.3 и Arduino DUE, Marline 2.0 и сервопривод, переключающий головы, система типа дондоло (всего 2 головы). 

Что сделано: раскоментированы строки веачале: 

// A dual-nozzle that uses a servomotor to raise/lower one (or both) of the nozzles

#define SWITCHING_NOZZLE 

#if ENABLED(SWITCHING_NOZZLE)

#define SWITCHING_NOZZLE_SERVO_NR 1

#define SWITCHING_NOZZLE_SERVO_ANGLES { 2, 55 }

#endif

И в конце указал общее количество сервоприводов:

#define NUM_SERVOS 1 // Servo index starts with 0 for M280 command (без нее прошивка сборку не проходила)

Что происходит: прошивка успешно проходит сборку и заливается. Серва исправно отрабатывает команды

M280 P1 S0 и M280 P1 S90, при этом команды типа T0 и T1 серва игнорирует эти команды, при этом ось Z выполняет откат/накат в 2 мм, Repetire Host рапортует, что переключение голов прошло успешно, соответственно, подготовленный файл (Simplify3d) для печати двумя головами, команды для смены голов то же игнорируются.

Теперь вопрос: я так понимаю, что прошивка не понимает команды формата T0 и T1, что и где нужно поправить в прошивке или как грамотно написать скипт для смены головы в simplify?

В Simplify3d в разделе script tool change написал следующее:

{IF NEWTOOL=0}; RIGHT Extruder is active

{IF NEWTOOL=0}M280 P1 S60; переключение на 2-й экструдер

{IF NEWTOOL=1}; LEFT Extruder is active

{IF NEWTOOL=1}M280 P1 S0; переключение на 1-й экструдер

В лоб, грубо и все равно не работает.

Прикладываю ссылку на прошивку и g-code файла под печать двумя экструдерами.