А точно. ошибка была.
Вот что то своял.... :-D
Посмотрите на ошибки (мб что-то добавить убрать).
И ещё вопрос теперь как вывести число из 2го кода(от 0 до 20) в 2\3 семисегментных индикатора. Т.е. как то умножить мощность на коэф. дискритивации *5 и преобразовать...