Как добавить пункты меню в Marlin?

Добры день, репраповцы!

Недавно переделал свой Prusia I3 Acrilic, даже не знаю во что, но с двумя экструдерами (заменил шпильки по оси Z на 4-х заходные винты, муфты на негибкие, нагревательный стол на MK3, блок питания, плату управления c Sanguinololu на MKS GEN 1.4, ну и соответсвенно поставил 2 хотенда ). От старого принтера остались только рама, двигатели (и то не все) и направляющие (если надо - выложу в отдельном посту как что и почему переделывал). Так Вот в чем вопрос: В родной плате от Geeetech в прошивке было несколько удобных плюшек:

• Автоматическое возвращение в основной интерфейс при определенном простое
• Пункт меню - смена филамента
  
  

Подскажите как и где отредактировать прошивку marlin, чтобы добавить эти функции. Пытался допытаться у гугла - не вышло, может не так запрос строил, конечно всякое бывает. От geeetech прошивку ставить не хочу, т.к. они там много чего под себя наворотили, да и старая она, а я скачал последнюю и настроил идеально под новую сборку принтера.