А можно ли добавить в marlin возможность ввода g-кодов?

Здравствуйте. Очень активно провожу битву с калибровкой принтера. И в очередной раз поймал себя на том, что очень удобно было бы иметь возможность прямо с экрана вводить g-code команды. С пк можно, но есть нервирующая проблема закрытого com порта. Только после перезагрузки Repetier-Host подключается к принтеру. Но после нескольких подключений перестает, говорит com порт занят. Нужно снова ребут..

Пробовал на флешку лить file.gcode, в котором писал нужные команды, но принтер зависает наглухо при попытке что-то исполнить. 

Плата MKS gen-l, экран mks tft24. Рядом у меня mks nano 1.2, которую я шил кастомной прошивкой, в ней был такой "терминал ввода". Этот же gen-l я шью чистым марлином, через vscode и PlatformIO. Сломал весь гугл, но ничего подобного так и не смог найти..