Подпрограмма для EAT модуля SIM800C

Нужно написать подпрограмму для GSM модуля SIM800C используя его Embeded AT:

ТЗ

1. Сделать "свою" АТ команду для приема команд от ведущего контроллера по интерфейсу UART.

2. В АТ команде, контроллер по UART, будет передавать номера выходов, которые необходимо включить. Выхода модуля GPIO, можно использовать, например служебные сигналы UART.

Например, включение первого и выключение 3-4 выходов:

AT@MY_OUT="1,0,0,0"

в ответ:

MY_OUT="1,0,0,0"

3. Программа должна выполняться в "фоне" работы модуля, тоесть модуль должен в штатном режиме работать по UART с контроллером и только по команде включать выхода.

4. Предоставить исходники подпрограммы и можно краткую инструкцию как компелировать и записать в модуль.