Marlin Firmware for Smartrap - with servo