Может сразу программу прислать?:) Как видно делать пытаешся из декодера. Сиди и на бумажке рисуй алгоритм декодирования. А потом задом наперед рисуй. А в алгоритме тебе тут помогут если только явные и бросающиеся в глаза ошибки....
(«Телесистемы»: Конференция «Микроконтроллеры и их применение»)