Написать ШИМ

Нужно написать шим. Документация имеется. Все остальные классы написаны. Язык программирования с++. Сфера разработки - Keil arm 5.16a. Структуру ПО прикрепил.

У нас есть программа, микроконтроллер, в который она зашита. В программе можно выставить длительность импульса и длительность периода. На выходе выдается шим. Все есть, кроме самого сигнала. В system unity все инициализируется(основные). 

Из main инициализируются основные модули. Их(основных) 4 штуки: клавиатура, логика, дисплей, шим. Из main в основном цикле вызывается keyboard и читаются коды кнопок: анализируется нажатие, передается в логику, если нажатие есть. 

И дальше логика выходит на дисплей информацию и дает в шим длительность импульса и длительность периода, а шим должен выдать на контактики. Есть описание на микроконтроллер. Нас интересует порт PI7. На этом порту висит светодиодик. Те мы сможем увидеть: чем больше выставим длительность импульса, тем ярче он будет светиться. На этом порту выход таймера timer4 - ch4 (канал). Тут есть описание на таймер. У таймера если режим формирование шим сигнала. В шиме уже немного реализовано. Шим: есть функция init, setPeriod, getPeriod, setImpulse, getImpulse, соответственно он хранит импульс и период. Функции контролируют чтобы импульс не вышел за период. Они уже реализованы. Все функции статические. Те объект класса не создается(как модуль). Можно задать в микросекундах. 

Есть длительность импульса, длительность периода в микросекундах. Нужно настроить таймер номер 4(функции init) и когда какие то данные приходят, либо длительность импульса, либо длительность периода, нужно чтобы таймер их корректировал, чтобы он правильно импульс выдавал. Нас интересует два файла. Shim.h и shim.cpp. 

Для каждого устройства, сначала описание, потом регистры. Управление таймером идет через регистры. в папке(hardware). Подается тактирование, настраиваются порты, те помимо таймера, нужно тактирование и порт I.