Декодер манчестерского кода на ассемблере

LISEN:                // прослушка линии
QBEQ START, r9, 15    // если принято 16 бит, то выход
MOV r2, 0                // обнуляем счетчик бит
QBBC CLR0, IN        // проверка на 0-ь.
QBBS SIT1, IN        // проверка на 1-цу
CLR0:                // метка установки 0
ADD r2, r2, 1        // счетчик длительности
QBBC CLR0, IN        // проверяет текущий уровень
QBGE CLR10, r2, 50   //  считаем, что  половина периода -  150 нс. Тогда переход на CLR10, если 0 уже больше 150
CLR r5.t16                // устанавливаем 0
LSR r5, r5, 1        // сдвигаем
ADD r9, r9, 1        // счетчик принятых бит
QBA LISEN        // возвращаемся на прослушку
CLR10:                // пришло два нуля
CLR r5.t16        // устанавливаем и сдвигаем
LSR r5, r5, 1
CLR r5.t16
LSR r5, r5, 1
ADD r9, r9, 2        // принято 2 бита
// WBC IN           // для того, чтобы не записывать лишних значений из линии
QBA LISEN        // возврат на прослушку
//--------------------------------------------------------------------------
SIT1:                // метка установки 1
ADD r2, r2, 1        // счетчик длительности
QBBS SIT1, IN        // проверяет текущий уровень
QBGE SIT01, r2, 50   //  считаем, что период 150 нс.
SIT r5.t16                // устанавливаем 1
LSR r5, r5, 1        // сдвигаем
ADD r9, r9, 1        // счетчик принятых бит
QBA LISEN                // возвращаемся на прослушку
SIT01:                // пришло две 1-ы
SIT r5.t16        // устанавливаем и сдвигаем
LSR r5, r5, 1
SIT r5.t16
LSR r5, r5, 1
ADD r9, r9, 2        // принято 2 бита
// WBC IN         для того, чтобы не записывать лишних значений из линии
QBA LISEN        // возврат на прослушку

// приемник для передачи сигнала со скоростью 2 мегабита
.origin 0
.entrypoint PRE
 
#include "GPIOCTR.hp"
#include "TRSBNI.hp"
 
#define USR0 21            // tid 0
#define USR1 22            // tid 1
#define USR2 23            // tid 2
#define USR3 24            // tid 3
#define GPIO1 0x4804C000   // адресс регистров GPIO1
#define PRU1_ARM_INT 20      // значение прерывания от PRU1 to ARM
 
#define ROM0 C24      // Локальная память PRU1
#define ROM1 C25      // Локальная память PRU0
#define IN r31.t6      // входной GPIO
 
//Определим основные регистры
#define REQ r1          // в этот регистр будет помещаться информация от PRU0
#define COUNT r2      // считает колличество принятых байт
#define VOTUE r3
//Приветствуем в программа приемника кода на PRU
PRE:
MOV R4, 2
INIT:
MOV REQ, 0
MOV COUNT, 8
MOV VOTUE, 0
LBCO REQ, ROM0, 0, 1      // выход из программы.
QBEQ EXIT, REQ, 0
START:
// Знаем, что в линии, если ничего не приходит идет сигнал низкого уровня
// Длительность задержки 45 нс. Проверяющий сигнал между байтами равен 9 мкс
// Или 4.5 HIGH и 4.5 LOW. Для начала будем ждать сигнал от PRU0, что он начал передачу
 
LBCO REQ, ROM0, 1, 1          // сюда помещаем разрешающее значения
QBNE START, REQ, 0         // Пока не будет установлен 0, будет прыгать на старт.
 
// в начале посылки каждого байта будем получать переход из 1 в 0. Задержка кажого сигнала 4.5 мкс
WBS IN      // ждем 4.5 мкс
WBC IN      // после этого нужно поставить задержку, равную 100
CDELAY 101   // компенсация задержки хоста 100+1. CDELAY 1 - 45 нс.
POOL:
REC9 IN, VOTUE, COUNT      //макрос приемника
SBCO VOTUE, ROM0, R4, 1      // запись в память
ADD R4, R4, 1            // добавляем 1 в счетчик бит
QBEQ EXIT, R4, 35
QBA INIT
// Дальше начинают приходить биты с длительностью от 480 до 500 нс (-45 нс)
EXIT:            // Ждем прерывания от хоста и выключаем PRU
MOV r31.b0, 20+16
HALT

.macro REC9         // Макрос приема данных с задержкой 9
.mparam IN, OUT, COUNT     // входные параметры: IN - вход GPIO; OUT - выходной регистр;
// COUNT - регистр, содержащий в себе число бит.
RECIVE:
QBBS SIT1X, IN   // проверяем 1 сейчас. Если нет, то сразу переход на 0
QBEQ BACK, COUNT, 0
SIT0X:
WBC IN      // проверям, точно ли 0.
CDELAY 9   // ждем 405 НС. До смены остается ещё 30 НС
WBC IN      // вторая проверка. Debbug точка
CDELAY 1   // после неё станет ясно, что пришло. Сигнал уже как 20 нс новый.
QBBC SIT00, IN  // пришел 0? Если нет, значит 1-ца. -25 нс.
SIT01:         // ЗАписываем переход из 0 в 1
CLR OUT.t1   // Записываем 01
SIT OUT.t0
LSL OUT, OUT, 2   //смещаем. -45нс.
CDELAY 9       // Сигналу осталось минимум 30 нс. -405-40+480
SUB COUNT, COUNT, 2   // принято 2-а байта. 25 нс.
CDELAY 1      // -20 нс нового сигнала
QBA RECIVE      // возвращаемся на прием. -25
SIT00:            //записываем переход из 0 в 0
CLR OUT.t1
CLR OUT.t0
LSL OUT, OUT, 2
CDELAY 9
SUB COUNT, COUNT, 2
CDELAY 1
QBA RECIVE      // возвращаемся на прием -25
SIT1X:         // для установки 1-ы и....
WBS IN      // аналогично с нулем
CDELAY 9
WBS IN
CDELAY 1
QBBS SIT11, IN
SIT10:
SIT OUT.t1
CLR OUT.t0
LSL OUT, OUT, 2
CDELAY 9
SUB COUNT, COUNT, 2
CDELAY 1
QBA RECIVE   // переход на прием
SIT11:
SIT OUT.t1
SIT OUT.t0
LSL OUT, OUT, 2
CDELAY 9
SUB COUNT, COUNT, 2
CDELAY 1
QBA RECIVE    // переход на прием
BACK:         // метка записи значения
LSR OUT, OUT, 2 // когда приходят последний 2 бита, то он сдвигаются влево. Это необходимо учесть
 
.endm