; 3-Фазное ШИМ управление инвертором двигателя (6-IGBT). U/f на 50Гц - сдвиг меджу линейными напряжениями WA и WB 72гр. ; Экспериментальный вариант для однофазного двигателя. Векторная ШИМ. ; PIC16F648А Кварц 20 МГц. Автор КДН(DC-AC). ;=============================================================================================== LIST p=16F648A ; Установка типа микроконтроллера. ;#include __CONFIG 26H ; ; ;=============================================================================================== ; Определение положения регистров специального назначения. ;==============================================================================================+ OptionR equ 81h ; Для установки WDT без предделителя. Status equ 03h ; Регистр выбора банка. TrisB equ 06h ; Регистр выбора направления работы выводов порта В. PortB equ 06h ; Регистр управления защелками порта В. TrisA equ 05h ; Регистр выбора направления работы выводов порта A. PortA equ 05h ; Регистр управления защелками порта A. Intcon equ 0Bh ; EEData equ 9Ah ; EEprom EECon1 equ 9Ch ; EECon2 equ 9Dh ; EEAdr equ 9Bh ; INDF equ 00h ; Косвенная адресация FSR equ 04h ; CMCON equ 1Fh ; Конфигурация входов (цифровые). PCL equ 02h ; Счётчик команд TMR0 equ 01h ; Таймер0 ;=============================================================================================== ; Определение названия и положения регистров общего назначения. ;=============================================================================================== Sec1 equ 20h ; Регистр константы.0 Sec2 equ 21h ; Регистр константы. Sec3 equ 22h ; Регистр константы. Sec4 equ 23h ; Регистр константы.0 Sec5 equ 24h ; Регистр константы.0 Sec6 equ 25h ; Регистр константы. Sec7 equ 26h ; Регистр константы. Sec8 equ 27h ; Регистр константы.0 Sec9 equ 28h ; Регистр константы.0 Sec10 equ 29h ; Регистр константы. Sec11 equ 2Ah ; Регистр константы. Sec12 equ 2Ch ; Регистр константы. Sec13 equ 2Bh ; Регистр константы множителя. AUTRUN equ 2Dh ; Регистр авторазгона.(управление разгоном 1-ый бит) Sec14 equ 2Eh ; Регистр управления делением частоты. Sec0 equ 2Fh ; Счетчик исполнитель констант. ;Sec00 equ 2Bh ; Регистр выбора констант не в памяти(по битам) Sec000 equ 30h ; Регистр выбора констант по вычисляемому переходу ;Sec010 equ 32h ; Регистр выбора констант не в памяти(по битам) SecMAX equ 31h ; Регистр ограничения максимальной частоты.(7-ой бит)-50Гц Sec100 equ 32h ; Регистр адреса ячейки памяти для косвенной адресации. Sec200 equ 33h ; Счетчик 13 чисел констант вращения SecM equ 34h ; Счетчик количества считанных данных. ACCSEL equ 35h ; Счетчик делитель времени ускорения. REVERS equ 36h ; Регистр выбора направления вращения. ON equ 37h ; Регистр флага достижения разгонной частоты (7-ой бит)и таймер задержки. ON2 equ 38h ; Регистр счёта значения минимальной разгонной частоты. AAW equ 39h ; Регистр сохранения аккумулятора ACCSEL2 equ 3Ah ; Счетчик таймер драйверов и таймер задержки. ON3 equ 3Bh ; Регистр установки значения минимальной разгонной частоты (используется для установки и загрузки значения разгонной частоты в EEPROM). NONR equ 3Ch ; Счетчик таймер драйверов и таймер задержки. MINUS equ 3Dh ; Регистр флага хода частот вниз. STOP equ 3Eh ; Регистр флагов условия выключения привода (7), начальной загрузки параметров(0), максимальной уставки частоты(1), максимальной уставки ускорения(2). ACCSELS equ 3Fh ; Регистр загрузки параметра ускорения и торможения ACCSELSS equ 40h ; Регистр установки значения времени разгона-торможения (используется для установки и загрузки значения в EEPROM). IMP equ 41h ; Регистр задержки для импульса показометра Sc0ZS equ 42h ; Регистр флагов управления нулевыми векторами Sec0Z equ 43h ; Исполняющий регистр флагов управления нулевыми векторами. ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! ; Оперативное хранение таблицы переключения ключей (формирования векторов) ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! PWM0H equ 49h PWM0L equ 50h PWM1 equ 51h PWM2 equ 52h PWM3 equ 53h PWM4 equ 54h PWM5 equ 55h ;PWM6 equ 56h PWM7 equ 57h PWM8 equ 58h PWM9 equ 59h PWM10 equ 5Ah PWM11 equ 5Bh PWM12 equ 5Ch PWM13 equ 5Dh PWM14 equ 5Eh PWM15 equ 5Fh PWM16 equ 60h PWM17 equ 61h ;PWM18 equ 62h PWM19 equ 63h PWM20 equ 64h PWM21 equ 65h PWM22 equ 66h PWM23 equ 67h PWM24 equ 68h ;=============================================================================================== ; Определение места размещения результатов операций. ;=============================================================================================== F equ 1 ; Результат направить в регистр. ;=============================================================================================== org 2104h ; Запись констант в EEPROM DE .100,.10,.255,.255,.255,.255,.255,.255,.255,.255,.255,.255, ;Параметры DE D'201', D'2', D'6', D'202', D'1', D'9', D'9', D'7', D'201', D'204', D'1', D'95', ; 1,00Hz 3,50Uн 1980,00Hz DE D'195', D'4', D'9', D'196', D'1', D'13', D'14', D'11', D'195', D'199', D'1', D'48', ; 2,00Hz 5,00Uн 2010,00Hz DE D'185', D'7', D'13', D'187', D'1', D'19', D'20', D'16', D'185', D'190', D'1', D'33', ; 3,00Hz 7,10Uн 2070,00Hz DE D'179', D'9', D'18', D'182', D'2', D'26', D'26', D'21', D'179', D'186', D'3', D'25', ; 4,00Hz 9,20Uн 2090,00Hz DE D'176', D'12', D'22', D'179', D'2', D'31', D'32', D'26', D'175', D'184', D'4', D'20', ; 5,00Hz 11,00Uн 2090,00Hz DE D'168', D'14', D'26', D'172', D'3', D'37', D'38', D'31', D'167', D'178', D'5', D'17', ; 6,00Hz 13,20Uн 2135,00Hz DE D'171', D'18', D'33', D'176', D'4', D'46', D'47', D'38', D'170', D'183', D'6', D'14', ; 7,00Hz 15,40Uн 2045,00Hz DE D'170', D'21', D'38', D'176', D'6', D'54', D'55', D'45', D'169', D'184', D'8', D'12', ; 8,00Hz 17,54Uн 2007,00Hz DE D'161', D'23', D'42', D'167', D'6', D'58', D'60', D'49', D'160', D'175', D'9', D'11', ; 9,00Hz 19,62Uн 2071,00Hz DE D'155', D'25', D'46', D'162', D'7', D'64', D'66', D'54', D'154', D'171', D'10', D'10', ; 10,00Hz 21,70Uн 2094,00Hz DE D'153', D'28', D'51', D'160', D'8', D'71', D'73', D'60', D'152', D'171', D'11', D'9', ; 11,00Hz 23,78Uн 2067,00Hz DE D'154', D'32', D'58', D'162', D'9', D'80', D'82', D'67', D'152', D'174', D'13', D'8', ; 12,01Hz 25,86Uн 2003,00Hz DE D'138', D'32', D'57', D'145', D'9', D'80', D'82', D'67', D'136', D'157', D'12', D'8', ; 13,01Hz 27,98Uн 2179,00Hz DE D'143', D'37', D'66', D'151', D'11', D'92', D'94', D'77', D'140', D'165', D'15', D'7', ; 14,00Hz 30,14Uн 2049,00Hz DE D'128', D'37', D'66', D'137', D'11', D'92', D'94', D'77', D'126', D'151', D'15', D'7', ; 15,01Hz 32,40Uн 2204,00Hz DE D'138', D'43', D'77', D'148', D'13', D'107', D'110', D'90', D'135', D'163', D'17', D'6', ; 16,00Hz 34,34Uн 2004,00Hz DE D'125', D'43', D'77', D'135', D'13', D'107', D'110', D'90', D'122', D'151', D'17', D'6', ; 17,01Hz 36,38Uн 2132,00Hz DE D'114', D'43', D'77', D'124', D'13', D'106', D'109', D'90', D'111', D'140', D'17', D'6', ; 18,00Hz 38,48Uн 2265,00Hz DE D'104', D'43', D'77', D'114', D'13', D'106', D'109', D'89', D'101', D'130', D'17', D'6', ; 19,00Hz 40,64Uн 2395,00Hz DE D'116', D'52', D'93', D'128', D'16', D'129', D'132', D'108', D'112', D'147', D'21', D'5', ; 20,00Hz 42,80Uн 2091,00Hz org 0 ; Начать выполнение программы с адреса 0 PC. goto Start ; Переход в ПП Start. org 4 ; Переход в прерывание. goto FROM ;*********************************************************************************************** ; Текст рабочей части программы. ;*********************************************************************************************** ; Установка направления работы портов. ;----------------------------------------------------------------------------------------------- Start movlw D'126' movwf PortB movlw .16 movwf PortA ;clrf PortA movlw .7 movwf CMCON ; Цифровые входы. bsf Status,5 ; Перейти в 1-й банк (установить в 1 5-й бит ; регистра Status). movlw .7 movwf TrisA movlw .128 ; Запись константы в W movwf TrisB ; Скопировать константу из W в регистр TrisB.(Конфигурация выводов) ;bcf Option,0 ;bcf Option,1 ;bcf OptionR,3 movlw .215 movwf OptionR ; Предделитель перед таймером от внутр такта 1 на 256 clrf EEAdr ; Очистка адреса EEPROM bcf Status,5 ; Перейти в 0-й банк (установить в 0 5-й бит ; регистра Status). clrf Intcon ; Нет прерываний. clrf TMR0 ; Сброс таймера ;----------------------------------------------------------------------------------------------- ; Начало ;----------------------------------------------------------------------------------------------- ;clrf PortB ;call NONRUN ;clrf PortA ;clrf Sec10 ;clrf Sec100 movlw .4 movwf Sec100 ; Начальный адрес EEPROM clrf ACCSEL2 clrf SecMAX clrf AUTRUN clrf Sec000 clrf REVERS clrf STOP clrf Sec0Z clrf Sc0ZS movlw .1 movwf Sec14 clrf ACCSEL movlw .0 movwf SecM ;movlw .50 ;movwf ON3 ; Разгон до 50Гц ;goto NONRUN call NONRUN movlw .47 ; Начальная пауза 2с для размагничивания двигателя (безопасный режим быстрого нажатия сброс-пуск). movwf Sec0 PNZ call NONRUN decfsz Sec0,1 goto PNZ ;btfss PortA,2 ; Команда входа в меню частот разгона ;goto MIN goto RUNN ;************************************************************************************* ; Ядро программы ШИМ *VECTOR* ;************************************************************************************* ;111111111111111111111111111111111111111111111111111111111111111111111111111111111111111111111 SSD1 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ1 call AA1 movfw PWM16 iorwf PortB,1 ;Логика переключений ключ A W1 call OFF movfw PWM16 movwf PortB ;Включаем 1 ключ A call AA2 movfw PWM17 movwf PortB ;Выключаем 6 ключ C call OFF movfw PWM12 movwf PortB ;Включаем 5 ключ C call AA3 ;Проверка условия пропуска нулевого вектора верхних ключей btfsc Sec0Z,4 goto VV1 movfw PWM13 movwf PortB ;Выключаем 4 ключ B call OFF movfw PWM0H movwf PortB ;Включаем 3 ключ B VV1 call AA4 call AA4 btfsc Sec0Z,4 ;Непрерывное включение, если нулевой вектор пропущен goto Z1 movfw PWM13 movwf PortB ; Z1 call OFF movfw PWM12 movwf PortB ; call AA3 movfw PWM17 movwf PortB ; call OFF movfw PWM16 movwf PortB ; call AA2 ;Проверка условия пропуска нулевого вектора нижних ключей btfsc Sec0Z,1 goto VV2 movfw PWM15 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV2 call AA1 btfsc Sec0Z,1 call VC ; коррекция времени decfsz Sec14,1 ;Управление делением частоты goto JJJ1 ;return bcf Intcon,7 ;AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA SSD1A movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ1A call AA4 movfw PWM16 iorwf PortB,1 ;Логика переключений ключ A call OFF movfw PWM16 movwf PortB ;Включаем 1 ключ A call AA5 movfw PWM17 movwf PortB ;Выключаем 6 ключ C call OFF movfw PWM12 movwf PortB ;Включаем 5 ключ C call AA6 ;Проверка условия пропуска нулевого вектора верхних ключей btfsc Sec0Z,1 goto VV1A movfw PWM13 movwf PortB ;Выключаем 4 ключ B call OFF movfw PWM0H movwf PortB ;Включаем 3 ключ B VV1A call AA1 call AA1 btfsc Sec0Z,1 ;Непрерывное включение, если нулевой вектор пропущен goto Z1A movfw PWM13 movwf PortB ; Z1A call OFF movfw PWM12 movwf PortB ; call AA6 movfw PWM17 movwf PortB ; call OFF movfw PWM16 movwf PortB ; call AA5 ;Проверка условия пропуска нулевого вектора нижних ключей btfsc Sec0Z,4 goto VV2A movfw PWM15 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV2A call AA4 btfsc Sec0Z,4 call VC ; коррекция времени decfsz Sec14,1 ;Управление делением частоты goto JJJ1A ;return bcf Intcon,7 ;22222222222222222222222222222222222222222222222222222222222222222222222222222222 SSD2 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ2 call AA4 movfw PWM8 iorwf PortB,1 ; W2 call OFF movfw PWM8 movwf PortB ; call AA5 movfw PWM11 movwf PortB ; call OFF movfw PWM12 movwf PortB ; call AA7 btfsc Sec0Z,0 goto VV3 movfw PWM13 movwf PortB ; call OFF movfw PWM0H movwf PortB ; VV3 call AA9 call AA9 btfsc Sec0Z,0 goto Z2 movfw PWM13 movwf PortB ; Z2 call OFF movfw PWM12 movwf PortB ; call AA7 movfw PWM11 movwf PortB ; call OFF movfw PWM8 movwf PortB ; call AA5 btfsc Sec0Z,4 goto VV4 movfw PWM7 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV4 call AA4 btfsc Sec0Z,4 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ2 ;return bcf Intcon,7 ;333333333333333333333333333333333333333333333333333333333333333333333333333333333333333333 SSD3 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ3 call AA1 movfw PWM8 iorwf PortB,1 ; W3 call OFF movfw PWM8 movwf PortB ; call AA2 movfw PWM11 movwf PortB ; call OFF movfw PWM12 movwf PortB ; call AA8 btfsc Sec0Z,0 goto VV5 movfw PWM13 movwf PortB ; call OFF movfw PWM0H movwf PortB ; VV5 call AA9 call AA9 btfsc Sec0Z,0 goto Z3 movfw PWM13 movwf PortB ; Z3 call OFF movfw PWM12 movwf PortB ; call AA8 movfw PWM11 movwf PortB ; call OFF movfw PWM8 movwf PortB ; call AA2 btfsc Sec0Z,1 goto VV6 movfw PWM7 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV6 call AA1 btfsc Sec0Z,1 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ3 ;return bcf Intcon,7 ;444444444444444444444444444444444444444444444444444444444444444444444444444444444444444444444444 SSD4 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ4 call AA9 movfw PWM8 iorwf PortB,1 W4 call OFF movfw PWM8 movwf PortB call AA8 movfw PWM11 movwf PortB call OFF movfw PWM12 movwf PortB call AA2 btfsc Sec0Z,1 goto VV7 movfw PWM13 movwf PortB call OFF movfw PWM0H movwf PortB VV7 call AA1 call AA1 btfsc Sec0Z,1 goto Z4 movfw PWM13 movwf PortB ; Z4 call OFF movfw PWM12 movwf PortB ; call AA2 movfw PWM11 movwf PortB ; call OFF movfw PWM8 movwf PortB ; call AA8 btfsc Sec0Z,0 goto VV8 movfw PWM7 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV8 call AA9 btfsc Sec0Z,0 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ4 ;return bcf Intcon,7 ;55555555555555555555555555555555555555555555555555555555555555555555555555555555555555555555555555 SSD5 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ5 call AA9 movfw PWM8 iorwf PortB,1 W5 call OFF movfw PWM8 movwf PortB call AA7 movfw PWM11 movwf PortB call OFF movfw PWM12 movwf PortB call AA5 btfsc Sec0Z,4 goto VV9 movfw PWM13 movwf PortB call OFF movfw PWM0H movwf PortB VV9 call AA4 call AA4 btfsc Sec0Z,4 goto Z5 movfw PWM13 movwf PortB ; Z5 call OFF movfw PWM12 movwf PortB ; call AA5 movfw PWM11 movwf PortB ; call OFF movfw PWM8 movwf PortB ; call AA7 btfsc Sec0Z,0 goto VV10 movfw PWM7 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV10 call AA9 btfsc Sec0Z,0 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ5 ;return bcf Intcon,7 ;666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666 SSD6 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ6 call AA1 movfw PWM8 iorwf PortB,1 W6 call OFF movfw PWM8 movwf PortB call AA6 movfw PWM9 movwf PortB call OFF movfw PWM4 movwf PortB call AA5 btfsc Sec0Z,4 goto VV11 movfw PWM5 movwf PortB call OFF movfw PWM0H movwf PortB VV11 call AA4 call AA4 btfsc Sec0Z,4 goto Z6 movfw PWM5 movwf PortB ; Z6 call OFF movfw PWM4 movwf PortB ; call AA5 movfw PWM9 movwf PortB ; call OFF movfw PWM8 movwf PortB ; call AA6 btfsc Sec0Z,1 goto VV12 movfw PWM7 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV12 call AA1 btfsc Sec0Z,1 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ6 ;return bcf Intcon,7 ;777777777777777777777777777777777777777777777777777777777777777777777777777777777777777777777777777 SSD7 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ7 call AA4 movfw PWM8 iorwf PortB,1 W7 call OFF movfw PWM8 movwf PortB call AA3 movfw PWM9 movwf PortB call OFF movfw PWM4 movwf PortB call AA2 btfsc Sec0Z,1 goto VV13 movfw PWM5 movwf PortB call OFF movfw PWM0H movwf PortB VV13 call AA1 call AA1 btfsc Sec0Z,1 goto Z7 movfw PWM5 movwf PortB ; Z7 call OFF movfw PWM4 movwf PortB ; call AA2 movfw PWM9 movwf PortB ; call OFF movfw PWM8 movwf PortB ; call AA3 btfsc Sec0Z,4 goto VV14 movfw PWM7 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV14 call AA4 btfsc Sec0Z,4 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ7 ;return bcf Intcon,7 ;888888888888888888888888888888888888888888888888888888888888888888888888888888888888888888888888 SSD8 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ8 call AA10 movfw PWM8 iorwf PortB,1 W8 call OFF movfw PWM8 movwf PortB call AA11 movfw PWM9 movwf PortB call OFF movfw PWM4 movwf PortB call AA8 btfsc Sec0Z,0 goto VV15 movfw PWM5 movwf PortB call OFF movfw PWM0H movwf PortB VV15 call AA9 call AA9 btfsc Sec0Z,0 goto Z8 movfw PWM5 movwf PortB ; Z8 call OFF movfw PWM4 movwf PortB ; call AA8 movfw PWM9 movwf PortB ; call OFF movfw PWM8 movwf PortB ; call AA11 btfsc Sec0Z,7 goto VV16 movfw PWM7 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV16 call AA10 btfsc Sec0Z,7 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ8 ;return bcf Intcon,7 ;99999999999999999999999999999999999999999999999999999999999999999999999999999999999999999 SSD9 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ9 call AA10 movfw PWM2 iorwf PortB,1 ; W9 call OFF movfw PWM2 movwf PortB ; call AA11 movfw PWM3 movwf PortB ; ;call OFF btfss PortB,7 ;!!!Проверка просадки DC звена. goto F02 ;nop ;nop btfss PortB,7 ;!!!Проверка просадки DC звена. goto F02 nop nop ;btfsc PortA,2 ;Снижение частоты вращения, стоп. ;bcf Intcon,5 ;Нет торможения с кнопки btfss PortA,2 ;Снижение частоты вращения, стоп. bsf Intcon,5 ;Торможение с кнопки nop movfw PWM4 movwf PortB ; call AA8 btfsc Sec0Z,0 goto VV17 movfw PWM5 movwf PortB ; call OFF movfw PWM0H movwf PortB ; VV17 call AA9 call AA9 btfsc Sec0Z,0 goto Z9 movfw PWM5 movwf PortB ; Z9 call OFF movfw PWM4 movwf PortB ; call AA8 movfw PWM3 movwf PortB ; call OFF movfw PWM2 movwf PortB ; call AA11 btfsc Sec0Z,7 goto VV18 movfw PWM1 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV18 call AA10 btfsc Sec0Z,7 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ9 ;return bcf Intcon,7 ;10101010101010101010101010101010101010101010101010101010101010101010101010101010101 SSD10 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ10 call AA4 movfw PWM2 iorwf PortB,1 W10 call OFF movfw PWM2 movwf PortB call AA3 movfw PWM3 movwf PortB call OFF movfw PWM4 movwf PortB call AA2 btfsc Sec0Z,1 goto VV19 movfw PWM5 movwf PortB call OFF movfw PWM0H movwf PortB VV19 call AA1 call AA1 btfsc Sec0Z,1 goto Z10 movfw PWM5 movwf PortB ; Z10 call OFF movfw PWM4 movwf PortB ; call AA2 movfw PWM3 movwf PortB ; call OFF movfw PWM2 movwf PortB ; call AA3 btfsc Sec0Z,4 goto VV20 movfw PWM1 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV20 call AA4 btfsc Sec0Z,4 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ10 ;return bcf Intcon,7 ;111111111111111111111111111111111111111111111111111111111111111111111111111111 SSD11 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ11 call AA1 movfw PWM2 iorwf PortB,1 W11 call OFF movfw PWM2 movwf PortB call AA6 movfw PWM3 movwf PortB call OFF movfw PWM4 movwf PortB call AA5 btfsc Sec0Z,4 goto VV21 movfw PWM5 movwf PortB call OFF movfw PWM0H movwf PortB VV21 call AA4 call AA4 btfsc Sec0Z,4 goto Z11 movfw PWM5 movwf PortB ; Z11 call OFF movfw PWM4 movwf PortB ; call AA5 movfw PWM3 movwf PortB ; call OFF movfw PWM2 movwf PortB ; call AA6 btfsc Sec0Z,1 goto VV22 movfw PWM1 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV22 call AA1 btfsc Sec0Z,1 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ11 ;return bcf Intcon,7 ;121212121212121212121212121212121212121212121212121212121212121212121212121212 SSD12 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ12 call AA9 movfw PWM2 iorwf PortB,1 ;Логика переключения ключей W12 call OFF movfw PWM2 movwf PortB ; call AA7 movfw PWM23 movwf PortB ;Выключаем 6 ключ C call OFF movfw PWM20 movwf PortB ;Включаем 5 ключ C call AA5 btfsc Sec0Z,4 goto VV23 movfw PWM21 movwf PortB ;Выключаем 4 ключ B call OFF movfw PWM0H movwf PortB ;Включаем 3 ключ B VV23 call AA4 call AA4 btfsc Sec0Z,4 goto Z12 movfw PWM21 movwf PortB ; Z12 call OFF movfw PWM20 movwf PortB ; call AA5 movfw PWM23 movwf PortB ; call OFF movfw PWM2 movwf PortB ; call AA7 btfsc Sec0Z,0 goto VV24 movfw PWM1 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV24 call AA9 btfsc Sec0Z,0 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ12 ;return bcf Intcon,7 ;131313131313131313131313131313131313131313131313131313131313131313131313131313 SSD13 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ13 call AA9 movfw PWM2 iorwf PortB,1 ;Логика переключения ключей W13 call OFF movfw PWM2 movwf PortB ; call AA8 movfw PWM23 movwf PortB ;Выключаем 6 ключ C call OFF movfw PWM20 movwf PortB ;Включаем 5 ключ C call AA2 btfsc Sec0Z,1 goto VV25 movfw PWM21 movwf PortB ;Выключаем 4 ключ B call OFF movfw PWM0H movwf PortB ;Включаем 3 ключ B VV25 call AA1 call AA1 btfsc Sec0Z,1 goto Z13 movfw PWM21 movwf PortB ; Z13 call OFF movfw PWM20 movwf PortB ; call AA2 movfw PWM23 movwf PortB ; call OFF movfw PWM2 movwf PortB ; call AA8 btfsc Sec0Z,0 goto VV26 movfw PWM1 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV26 call AA9 btfsc Sec0Z,0 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ13 ;return bcf Intcon,7 ;141414141414141414141414141414141414141414141414141414141414141414141414141414 SSD14 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ14 call AA1 movfw PWM2 iorwf PortB,1 W14 call OFF movfw PWM2 movwf PortB call AA2 movfw PWM23 movwf PortB call OFF movfw PWM20 movwf PortB call AA8 btfsc Sec0Z,0 goto VV27 movfw PWM21 movwf PortB call OFF movfw PWM0H movwf PortB VV27 call AA9 call AA9 btfsc Sec0Z,0 goto Z14 movfw PWM21 movwf PortB ; Z14 call OFF movfw PWM20 movwf PortB ; call AA8 movfw PWM23 movwf PortB ; call OFF movfw PWM2 movwf PortB ; call AA2 btfsc Sec0Z,1 goto VV28 movfw PWM1 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV28 call AA1 btfsc Sec0Z,1 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ14 ;return bcf Intcon,7 ;151515151515151515151515151515151515151515151515151515151515151515151515151515 SSD15 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ15 call AA4 movfw PWM2 iorwf PortB,1 ; W15 call OFF movfw PWM2 movwf PortB ; call AA5 movfw PWM23 movwf PortB ; call OFF movfw PWM20 movwf PortB ; call AA7 btfsc Sec0Z,0 goto VV29 movfw PWM21 movwf PortB ; call OFF movfw PWM0H movwf PortB ; VV29 call AA9 call AA9 btfsc Sec0Z,0 goto Z15 movfw PWM21 movwf PortB ; Z15 call OFF movfw PWM20 movwf PortB ; call AA7 movfw PWM23 movwf PortB ; call OFF movfw PWM2 movwf PortB ; call AA5 btfsc Sec0Z,4 goto VV30 movfw PWM1 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV30 call AA4 btfsc Sec0Z,4 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ15 ;return bcf Intcon,7 ;161616161616161616161616161616161616161616161616161616161616161616161616161616 SSD16 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ16 call AA4 movfw PWM16 iorwf PortB,1 W16 call OFF movfw PWM16 movwf PortB call AA5 movfw PWM19 movwf PortB call OFF movfw PWM20 movwf PortB call AA6 btfsc Sec0Z,1 goto VV31 movfw PWM21 movwf PortB call OFF movfw PWM0H movwf PortB VV31 call AA1 call AA1 btfsc Sec0Z,1 goto Z16 movfw PWM21 movwf PortB ; Z16 call OFF movfw PWM20 movwf PortB ; call AA6 movfw PWM19 movwf PortB ; call OFF movfw PWM16 movwf PortB ; call AA5 btfsc Sec0Z,4 goto VV32 movfw PWM15 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV32 call AA4 btfsc Sec0Z,4 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ16 ;return bcf Intcon,7 ;171717171717171717171717171717171717171717171717171717171717171717171717171717 SSD17 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ17 call AA1 movfw PWM16 iorwf PortB,1 W17 call OFF movfw PWM16 movwf PortB call AA2 movfw PWM19 movwf PortB call OFF movfw PWM20 movwf PortB call AA3 btfsc Sec0Z,4 goto VV33 movfw PWM21 movwf PortB call OFF movfw PWM0H movwf PortB VV33 call AA4 call AA4 btfsc Sec0Z,4 goto Z17 movfw PWM21 movwf PortB ; Z17 call OFF movfw PWM20 movwf PortB ; call AA3 movfw PWM19 movwf PortB ; call OFF movfw PWM16 movwf PortB ; call AA2 btfsc Sec0Z,1 goto VV34 movfw PWM15 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV34 call AA1 btfsc Sec0Z,1 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ17 ;return bcf Intcon,7 ;181818181818181818181818181818181818181818181818181818181818181818181818181818 SSD18 movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ18 call AA9 movfw PWM16 iorwf PortB,1 W18 call OFF movfw PWM16 movwf PortB call AA8 movfw PWM19 movwf PortB ;call OFF btfss PortB,7 ;!!!Проверка просадки DC звена. goto F02 ;nop ;nop btfss PortB,7 ;!!!Проверка просадки DC звена. goto F02 nop nop ;btfsc PortA,2 ;Снижение частоты вращения, стоп. ;bcf Intcon,5 ;Нет торможения с кнопки btfss PortA,2 ;Снижение частоты вращения, стоп. bsf Intcon,5 ;Торможение с кнопки nop movfw PWM20 movwf PortB call AA11 btfsc Sec0Z,7 goto VV35 movfw PWM21 movwf PortB call OFF movfw PWM0H movwf PortB VV35 call AA10 call AA10 btfsc Sec0Z,7 goto Z18 movfw PWM21 movwf PortB ; Z18 call OFF movfw PWM20 movwf PortB ; call AA11 movfw PWM19 movwf PortB ; nop nop ;call OFF ;btfsc PortA,1 ;bcf Intcon,5 ;Нет разгона с кнопки btfss ON,7 bsf Intcon,5 ;Авторазгон до фиксированной частоты btfsc STOP,7 ;Выход из вращения, стоп. goto Stop ;nop ;nop nop btfss PortA,1 ;Разгон с кнопки bsf Intcon,5 movfw PWM16 movwf PortB ; call AA8 btfsc Sec0Z,0 goto VV36 movfw PWM15 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV36 call AA9 btfsc Sec0Z,0 call VC decfsz Sec14,1 ;Управление делением частоты goto JJJ18 bcf Intcon,7 ;goto SSD1 ;BBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBB SSD1B movfw Sec13 ; Установка множителя деления частоты Шим movwf Sec14 movfw Sc0ZS ; Управление нулевыми векторами movwf Sec0Z bsf Intcon,7 ; Разрешить прерывания JJJ1B call AA9 movfw PWM16 iorwf PortB,1 ;Логика переключений ключ A call OFF movfw PWM16 movwf PortB ;Включаем 1 ключ A call AA8 movfw PWM17 movwf PortB ;Выключаем 6 ключ C call OFF movfw PWM12 movwf PortB ;Включаем 5 ключ C call AA11 ;Проверка условия пропуска нулевого вектора верхних ключей btfsc Sec0Z,7 goto VV1B movfw PWM13 movwf PortB ;Выключаем 4 ключ B call OFF movfw PWM0H movwf PortB ;Включаем 3 ключ B VV1B call AA10 call AA10 btfsc Sec0Z,7 ;Непрерывное включение, если нулевой вектор пропущен goto Z1B movfw PWM13 movwf PortB ; Z1B call OFF movfw PWM12 movwf PortB ; call AA11 movfw PWM17 movwf PortB ; call OFF movfw PWM16 movwf PortB ; call AA8 ;Проверка условия пропуска нулевого вектора нижних ключей btfsc Sec0Z,0 goto VV2B movfw PWM15 movwf PortB ; call OFF movfw PWM0L movwf PortB ;Все нижние ключи VV2B call AA9 btfsc Sec0Z,0 call VC ; коррекция времени decfsz Sec14,1 ;Управление делением частоты goto JJJ1B ;return bcf Intcon,7 goto SSD1 ;()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()() ; Отработка констант ШИМ ;)()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()()( AA1 movfw Sec1 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA2 movfw Sec2 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA3 movfw Sec3 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA4 movfw Sec4 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA5 movfw Sec5 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA6 movfw Sec6 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA7 movfw Sec7 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA8 movfw Sec8 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA9 movfw Sec9 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA10 movfw Sec10 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return AA11 movfw Sec11 ;Установка константы movwf Sec0 ; call NTT ;Отработка константы return ;AA12 movfw Sec12 ;Установка константы ;movwf Sec0 ; ;call NTT ;Отработка константы ;return ;$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$ ; Время задержки между переключениями силовых ключей (2mks) ;$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$ OFF nop nop nop nop nop return ;&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&& ; Программа отработки задержек. ;&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&& NTT clrwdt QQ decfsz Sec0,1 goto QQ return ;@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ ; Флаг векторной модуляции и задержка ;@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ VC ;bsf Sec00Z,0 call OFF return ;******************************************************************************* ; Управление, торможение и изменение частот вращения вектора(констант) ;******************************************************************************* Stop clrf Intcon movlw .126 movwf PortB ;clrf Sec100 movlw .4 movwf Sec100 ; Начальный адрес EEPROM clrf AUTRUN clrf Sec000 clrf REVERS clrf STOP clrf Sec0Z clrf Sc0ZS movlw .0 movwf SecM movlw .1 movwf Sec14 clrf SecMAX call NONRUN ;clrf PortA ;movlw .24 ;movwf PortA ; бит прерывания и флаг счёта частот вниз. call NONRUN movlw .16 movwf PortA ;оставляем флаг счёта частот вниз, для сброса показаний. call NONRUN ;=================================================================================== ; Проверка DC звена, разрешения ограничения поля (разгон >50Гц) и ожидание пуска ;=================================================================================== ;clrf PortA ;Снятие флага счёта частот, готовность. call NONRUN RUNN clrf REVERS clrwdt ;movf ON3,0 ;movwf ON2 ;Установка заданной частоты clrf ON clrf Sec000 btfsc PortA,0 ;Выбор направления вращения поля bsf REVERS,7 btfss PortB,7 ;Опрос DC звена goto F02 btfss PortB,7 goto F02 btfss PortA,2 goto Stop2 btfss PortA,2 goto Stop2 movlw .127 ;Индикация готовности к включению movwf PortB btfsc PortA,1 goto RUNN btfsc PortA,1 goto RUNN ;RUNNN btfss PortA,1 ;goto RUNNN ;btfss PortA,1 ;goto RUNNN ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! ; Подготовка драйверов силовых ключей ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! movlw .42 movwf PortB ;Включаем всю нижнюю (эмиттерную) группу - заряд верхних драйверов. call NONRUN call NONRUN ;call NONRUN movlw .150 movwf Sec0 YY call OFF clrwdt movlw .42 movwf PortB ;Включаем всю нижнюю (эмиттерную) группу ZAR decfsz ACCSEL2,F goto ZAR ZAR2 decfsz ACCSEL2,F goto ZAR2 movlw .126 movwf PortB ;Выключаем группу call OFF movlw .84 movwf PortB ;Включаем всю верхнюю (коллекторную) группу ZA decfsz ACCSEL2,F goto ZA ZA2 decfsz ACCSEL2,F goto ZA2 movlw .126 movwf PortB ;Выключаем группу decfsz Sec0,1 goto YY ;################################################################################### call Delay ; начальная загрузка параметров bsf STOP,0 movfw Sec1 movwf ON2 ;Установить параметр частоты авторазгона. movfw Sec2 movwf ACCSELS ;Установить параметр ускорения и торможения call Delay ;Смена констант частот clrf TMR0 ;Сброс таймера bcf Intcon,2 ;Сброс флага прерывания от TMR0 ;bsf Intcon,7 ;Разрешить прерывания btfsc REVERS,7 goto VECTORr ;ШИМ реверс goto VECTOR ;ШИМ ;#################################################################################### ; Загрузка таблицы переключения для прямого вращения ;#################################################################################### VECTOR movlw .42 movwf PWM0L movlw .84 movwf PWM0H movlw .106 movwf PWM1 movlw .74 movwf PWM2 movlw .90 movwf PWM3 movlw .82 movwf PWM4 movlw .86 movwf PWM5 ;movlw .110 ;movwf PWM6 movlw .58 movwf PWM7 movlw .50 movwf PWM8 movlw .114 movwf PWM9 movlw .118 movwf PWM10 movlw .54 movwf PWM11 movlw .52 movwf PWM12 movlw .116 movwf PWM13 movlw .62 movwf PWM14 movlw .46 movwf PWM15 movlw .44 movwf PWM16 movlw .60 movwf PWM17 ;movlw .108 ;movwf PWM18 movlw .108 movwf PWM19 movlw .76 movwf PWM20 movlw .92 movwf PWM21 movlw .110 movwf PWM22 movlw .78 movwf PWM23 movlw .94 movwf PWM24 goto SSD15 ;#################################################################################### ; Загрузка таблицы переключения для обратного вращения ;#################################################################################### VECTORr movlw .42 movwf PWM0L movlw .84 movwf PWM0H movlw .58 movwf PWM1 movlw .50 movwf PWM2 movlw .114 movwf PWM3 movlw .82 movwf PWM4 movlw .86 movwf PWM5 ;movlw .122 ;movwf PWM6 movlw .106 movwf PWM7 movlw .74 movwf PWM8 movlw .90 movwf PWM9 movlw .94 movwf PWM10 movlw .78 movwf PWM11 movlw .76 movwf PWM12 movlw .92 movwf PWM13 movlw .110 movwf PWM14 movlw .46 movwf PWM15 movlw .44 movwf PWM16 movlw .108 movwf PWM17 ;movlw .124 ;movwf PWM18 movlw .60 movwf PWM19 movlw .52 movwf PWM20 movlw .116 movwf PWM21 movlw .62 movwf PWM22 movlw .54 movwf PWM23 movlw .118 movwf PWM24 goto SSD15 ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! ;=================================================================================== ; Изменение частот вращения+ ;=================================================================================== Delay clrwdt btfss STOP,0 goto SETUP ;movlw .8 ;Не выдавать бит счёта. ;movwf PortA ; Бит прерывания счёт вверх. movfw ACCSELS ;Загрузка параметра ускорения movwf ACCSEL ;Время разгона (между переключениями ступеней вверх). SETUP clrf MINUS ;Сброс флага, частота идёт вверх. ;btfss SecM,5 ;Считывание всех констант из EEPROM завершено или нет ;goto DEREC movlw .21 bcf Status,2 ;Сбросить флаг 0 subwf SecM,0 ;Проверка на конечную нижнюю константу btfss Status,2 goto DEREC ;Считывание всех констант из EEPROM завершено или нет ;------------------------------------------------------------------------------- ; Адресация частот вращения ;------------------------------------------------------------------------------- incf Sec000,1 ;Увеличение частоты на 1 movfw Sec000 lgoto SELECT ;Уходим на выбор частот по вычисляемому переходу ;------------------------------------------------------------------------------- ; Извлечение таблицы констант из EEPROM памяти данных ;------------------------------------------------------------------------------- DEREC movlw .12 ;Число чисел, формирующих одну частоту. movwf Sec200 movlw .32 movwf FSR ; Запись начального адреса. REC movf Sec100,0 clrf Status bsf Status,5 movwf EEAdr ; Стандартная процедура чтения EEPROM. ;bsf Status,5 bsf EECon1,0 ;bcf Status,5 movf EEData,0 clrf Status movwf INDF ; Запись констант по косвенной адресации. incf FSR,F ; Следующий адрес. incf Sec100,F decfsz Sec200,F ; Отслеживание окончания записи 8 чисел. goto REC incf SecM,F ; Отслеживание считывания чисел частот. ;incf ON,F ; Отслеживание начальной скорости (10Гц) goto ROTOR ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! ;=================================================================================== ; Изменение частот вращения- ;=================================================================================== Delayn clrwdt movlw .2 bcf Status,2 ;Сбросить флаг 0 subwf SecM,0 ;Проверка на конечную нижнюю константу btfsc Status,2 goto ROTORST ;Выключения привода. ;movlw .24 ;movwf PortA ; Бит прерывания и флаг счёта вниз. movfw ACCSELS ;Загрузка параметра торможения movwf ACCSEL ;Время замедления (между переключениями ступеней вниз). bsf MINUS,7 ;Установка флага хода частоты вниз. movlw .254 bcf Status,0 ;Сброс флага переноса. addwf Sec000,0 ;Проверка на число 1 и 0 в Sec000 btfss Status,0 goto DERECn ;------------------------------------------------------------------------------- ; Адресация частот вращения ;------------------------------------------------------------------------------- decf Sec000,1 ;Уменьшение частоты на 1 movfw Sec000 lgoto SELECT ;Уходим на выбор частот по вычисляемому переходу ;------------------------------------------------------------------------------- ; Извлечение таблицы констант из EEPROM памяти данных ;------------------------------------------------------------------------------- DERECn movlw .1 bcf Status,2 ;Сброс флага нуля. subwf Sec000,0 ;Проверка на число 0 в Sec000 btfsc Status,2 goto IZSEL ;Переход из констант флеш clrf Sec000 ;Сброс верхних ступеней в 0 movlw .13 subwf Sec100,1 ; Сдвиг на одну ступень назад RECnZ movlw .12 ;Число чисел, формирующих одну частоту. movwf Sec200 movlw .43 movwf FSR ; Запись начального адреса. RECn movf Sec100,0 clrf Status bsf Status,5 movwf EEAdr ; Стандартная процедура чтения EEPROM. ;bsf Status,5 bsf EECon1,0 ;bcf Status,5 movf EEData,0 clrf Status movwf INDF ; Запись констант по косвенной адресации. decf FSR,F ; Следующий адрес.(назад) decf Sec100,F decfsz Sec200,F ; Отслеживание окончания записи 8 чисел. goto RECn decf SecM,F ; Отслеживание считывания чисел частот. movlw .13 addwf Sec100,1 ; Возвращение счётчика назад на одну ступень ;incf ON,F ; Отслеживание начальной скорости (10Гц) goto ROTOR IZSEL movlw .1 subwf Sec100,1 ; Нет Сдвига на одну ступень назад clrf Sec000 ;Сброс верхних ступеней в 0 incf SecM,1 ;Чтоб сохранить постоянство счёта констант в EEPROM goto RECnZ ;+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ; Отсчёт частот вращения и подхват ;+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ROTOR btfsc MINUS,7 goto ROTORn ; Операции с частотами назад. ;movlw .3 ; Разгон до 50 Гц за 2 с. ;movwf ACCSEL ;Время разгона (между переключениями ступеней вверх). incf ON2,F ; Отслеживание заданной начальной скорости goto POLE ROTORST bsf STOP,7 ;Флаг выключения привода поднят. ROTORn bsf ON,7 ;Прервать авторазгон при нажатии в разгоне. ;__________+++++++улучшение перехода между множителями ШИМ+++++++______________ POLE movlw .20 movwf IMP PRD decfsz IMP,1 goto PRD ;clrf PortA ;Снять бит прерывания, смена частот завершена. bcf Status,0 movfw Sec14 ;Выбор минимального остаточного множителя для следующей частоты во избежание подмагничивания subwf Sec13,0 btfsc Status,0 return movfw Sec13 movwf Sec14 return ;############################################################################ ; Программная задержка 39.47mks ;############################################################################ NONRUN clrf ACCSEL2 clrf NONR NONRUN1 decfsz ACCSEL2,F ;Програмная задержка. goto NONRUN1 clrwdt decfsz NONR,F goto NONRUN1 return ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! ; Ошибка F0.2 Низкое напряжение DC звена ;!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! F02 clrwdt ;Ошибка DC звена F0.2 clrf Intcon movlw .126 movwf PortB movlw .16 ; Тушим светодиоды movwf PortA call NONRUN call NONRUN call NONRUN movlw .127 movwf PortB call NONRUN call NONRUN call NONRUN goto F02 ;***************************************************************************** ; Стоп ;***************************************************************************** Stop2 clrf Intcon movlw .126 movwf PortB clrwdt btfss PortA,2 goto Stop2 btfss PortA,2 goto Stop2 goto RUNN ;)))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))) ; Установки разгонной частоты и времени разгона-торможения (не используются) ;)))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))) MIN call NONRUN btfss PortA,2 goto MIN btfss PortA,2 goto MIN movlw .149 ; 1,0 Hz movwf ON3 call SETT ;call SETT VBN clrwdt btfss PortA,2 goto ACCSELER btfss PortA,2 goto ACCSELER btfsc PortA,1 goto VBN btfsc PortA,1 goto VBN btfsc STOP,1 goto VB decf ON3,F ; Изменение регистра частоты разгона movlw .1 bcf Status,2 ; Сброс флага 0 subwf ON3,0 btfsc Status,2 bsf STOP,1 ; Максимальная уставка. call SETT VB clrwdt btfss PortA,1 goto VB btfss PortA,1 goto VB goto VBN ;\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\ ACCSELER movlw .24 ; Установка времени разгона-торможения movwf PortA ; бит прерывания и флаг счёта частот вниз. call NONRUN movlw .16 movwf PortA ;оставляем флаг счёта частот вниз, для сброса показаний. call NONRUN clrf PortA MIN2 call NONRUN btfss PortA,2 goto MIN2 btfss PortA,2 goto MIN2 movlw .1 ;Минимальное время movwf ACCSELSS call SETT ;call SETT VBN2 clrwdt btfss PortA,2 goto EEPR btfss PortA,2 goto EEPR btfsc PortA,1 goto VBN2 btfsc PortA,1 goto VBN2 btfsc STOP,2 goto VB2 incf ACCSELSS,1 ;Изменение регистра времени разгона-торможения btfsc ACCSELSS,4 bsf STOP,2 ; Максимальная уставка.(16) call SETT call SETT VB2 clrwdt btfss PortA,1 goto VB2 ;btfss PortA,1 ;goto VB2 goto VBN2 SETT movlw .8 ; Выдача счётного бита (для индикации) movwf PortA call NONRUN clrf PortA call NONRUN return ;)))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))))) ; Запись параметров в EEPROM ; ((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((((( EEPR movfw ON3 ;Запись данных разгонной частоты call RECEEP movfw ACCSELSS call RECEEP goto Stop ;Выход в готовность ;&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&& RECEEP bsf Status,5 movwf EEData bsf EECon1,2 ;Разрешить запись movlw .85 movwf EECon2 movlw .170 movwf EECon2 bsf EECon1,1 MMMM btfsc EECon1,1 goto MMMM bcf EECon1,2 ;Запретить запись incf EEAdr,1 bcf Status,5 return ;00000000000000000000000000000000000000000000000000000000000000000000000000000 ; Прерывание по смене констант частот вращения поля ;00000000000000000000000000000000000000000000000000000000000000000000000000000 FROM movwf AAW ;Сохранение аккумулятора movlw .150 bsf Status,0 subwf ON2,0 btfsc Status,0 bsf ON,7 ;Установить флаг достижения заданной частоты decfsz ACCSEL,1 ;Деление времени прерывания (время переключения ступеней) goto ZZF btfss PortA,2 ;Не отключать прерывания если нажата кнопка снижения частоты goto ZZFFn btfss SecMAX,7 goto NOMAX bcf Intcon,5 ;Отключаем прерывания TMR0 если набрана максимальная частота. incf ACCSEL,1 ;Увеличиваем, чтоб след. прерывание вниз прошло сразу (1 в ACCSELe) bsf ON,7 ;Установить флаг достижения заданной частоты, чтоб не включались прерывания goto ZZF ;Не осуществлять далее ускорение, (ограничение максимальной частоты) NOMAX btfss PortA,1 ;Не отключать прерывания если нажата кнопка разгона goto ZZFF btfss ON,7 ;Авторазгон goto ZZFF bcf Intcon,5 ;Отключаем прерывания TMR0 если набрана конечная частота авторазгона. incf ACCSEL,1 ;Увеличиваем, чтоб след. прерывание прошло сразу (1 в ACCSELe) goto ZZF ;Нет далее разгона ZZFF call Delay ;Смена констант вращения+ ZZF clrf Sc0ZS ;Управление нулевыми векторами decfsz Sec1,0 goto V1 bsf Sc0ZS,1 V1 decfsz Sec4,0 goto V2 bsf Sc0ZS,4 V2 decfsz Sec9,0 goto V3 bsf Sc0ZS,0 V3 decfsz Sec10,0 goto V4 bsf Sc0ZS,7 V4 clrf TMR0 ;Выход из прерывания movfw AAW bcf Intcon,2 ;Сброс флага прерывания. retfie ZZFFn btfss STOP,7 ;Не изменять более частоты, нижний предел, флаг стопа. call Delayn ;Переход на смену констант вращения- goto ZZF ;Выход из прерывания ;^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^ ; Прокрутка кодовой страницы (тут может быть любая программа) ;^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^ nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop nop ;&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&& ; Аресация констант ;&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&& SELECT addwf PCL,F nop goto START1 goto START2 goto START3 goto START4 goto START5 goto START6 goto START7 goto START8 goto START9 goto START10 goto START11 goto START12 goto START13 goto START14 goto START15 goto START16 goto START17 goto START18 goto START19 goto START20 goto START21 goto START22 goto START23 goto START24 goto START25 goto START26 goto START27 goto START28 goto START29 goto START30 goto START31 goto START32 goto START33 goto START34 goto START35 goto START36 goto START37 goto START38 goto START39 goto START40 goto START41 goto START42 goto START43 goto START44 goto START45 goto START46 goto START47 goto START48 goto START49 goto START50 goto START51 goto START52 goto START53 goto START54 goto START55 goto START56 goto START57 goto START58 goto START59 goto START60 ;goto START61 ;goto START62 ;goto START63 ;goto START64 ;goto START65 ;goto START66 ;goto START67 ;goto START68 ;goto START69 ;goto START70 ;goto START71 ;goto START72 ;goto START73 ;goto START74 ;goto START75 ;goto START76 ;goto START77 ;goto START78 ;goto START79 ;goto START80 ;goto START81 ;goto START82 ;goto START83 ;goto START84 ;goto START85 ;goto START86 ;goto START87 ;goto START88 ;goto START89 ;goto START90 ;goto START91 ;goto START92 ;goto START93 ;goto START94 ;goto START95 ;goto START96 ;goto START97 ;goto START98 ;goto START99 ;goto START100 ;goto START101 ;goto START102 ;goto START103 ;goto START104 ;goto START105 ;goto START106 ;goto START107 ;goto START108 ;goto START109 ;goto START110 ;goto START111 ;goto START112 ;goto START113 ;goto START114 ;goto START115 ;goto START116 ;goto START117 ;goto START118 ;*********************************************************************************************** ; Константы ;*********************************************************************************************** START60 movlw D'1' ; 80,06Hz movwf Sec1 ; 129,00Uн movlw D'68' ; 3483,00Hz movwf Sec2 movlw D'164' movwf Sec3 movlw D'1' movwf Sec4 movlw D'25' movwf Sec5 movlw D'207' movwf Sec6 movlw D'207' movwf Sec7 movlw D'164' movwf Sec8 movlw D'1' movwf Sec9 movlw D'26' movwf Sec10 movlw D'41' movwf Sec11 movlw D'2' movwf Sec13 bsf SecMAX,7 bsf PortA,4 ;Индикация частоты 75(80)Гц lgoto ROTOR START59 movlw D'1' ; 79,02Hz movwf Sec1 ; 128,00Uн movlw D'70' ; 3440,00Hz movwf Sec2 movlw D'166' movwf Sec3 movlw D'1' movwf Sec4 movlw D'26' movwf Sec5 movlw D'209' movwf Sec6 movlw D'209' movwf Sec7 movlw D'166' movwf Sec8 movlw D'1' movwf Sec9 movlw D'27' movwf Sec10 movlw D'41' movwf Sec11 movlw D'2' movwf Sec13 bcf SecMAX,7 bcf PortA,4 ;Индикация частоты 75Гц lgoto ROTOR START58 movlw D'1' ; 78,02Hz movwf Sec1 ; 128,00Uн movlw D'71' ; 3388,00Hz movwf Sec2 movlw D'168' movwf Sec3 movlw D'1' movwf Sec4 movlw D'27' movwf Sec5 movlw D'212' movwf Sec6 movlw D'212' movwf Sec7 movlw D'168' movwf Sec8 movlw D'1' movwf Sec9 movlw D'28' movwf Sec10 movlw D'41' movwf Sec11 movlw D'2' movwf Sec13 lgoto ROTOR START57 movlw D'1' ; 76,98Hz movwf Sec1 ; 129,00Uн movlw D'71' ; 3342,00Hz movwf Sec2 movlw D'171' movwf Sec3 movlw D'1' movwf Sec4 movlw D'27' movwf Sec5 movlw D'216' movwf Sec6 movlw D'216' movwf Sec7 movlw D'171' movwf Sec8 movlw D'1' movwf Sec9 movlw D'28' movwf Sec10 movlw D'42' movwf Sec11 movlw D'2' movwf Sec13 lgoto ROTOR START56 movlw D'1' ; 76,02Hz movwf Sec1 ; 129,00Uн movlw D'73' ; 3296,00Hz movwf Sec2 movlw D'173' movwf Sec3 movlw D'1' movwf Sec4 movlw D'27' movwf Sec5 movlw D'219' movwf Sec6 movlw D'219' movwf Sec7 movlw D'173' movwf Sec8 movlw D'1' movwf Sec9 movlw D'28' movwf Sec10 movlw D'43' movwf Sec11 movlw D'2' movwf Sec13 lgoto ROTOR START55 movlw D'1' ; 75,04Hz movwf Sec1 ; 128,00Uн movlw D'74' ; 3246,00Hz movwf Sec2 movlw D'176' movwf Sec3 movlw D'1' movwf Sec4 movlw D'28' movwf Sec5 movlw D'221' movwf Sec6 movlw D'221' movwf Sec7 movlw D'176' movwf Sec8 movlw D'1' movwf Sec9 movlw D'29' movwf Sec10 movlw D'43' movwf Sec11 movlw D'2' movwf Sec13 ;bsf PortA,4 ;Индикация частоты 75Гц ;movlw .37 ;movwf ACCSEL ;Время паузы разгона, чтоб чётко поймать 75Гц. ;bsf SecMAX,7 lgoto ROTOR START54 movlw D'1' ; 73,97Hz movwf Sec1 ; 129,00Uн movlw D'75' ; 3201,00Hz movwf Sec2 movlw D'179' movwf Sec3 movlw D'1' movwf Sec4 movlw D'28' movwf Sec5 movlw D'225' movwf Sec6 movlw D'225' movwf Sec7 movlw D'179' movwf Sec8 movlw D'1' movwf Sec9 movlw D'29' movwf Sec10 movlw D'44' movwf Sec11 movlw D'2' movwf Sec13 ;bcf PortA,4 ;Индикация частоты 75Гц ;bcf SecMAX,7 lgoto ROTOR START53 movlw D'1' ; 73,04Hz movwf Sec1 ; 128,00Uн movlw D'76' ; 3147,00Hz movwf Sec2 movlw D'181' movwf Sec3 movlw D'1' movwf Sec4 movlw D'29' movwf Sec5 movlw D'228' movwf Sec6 movlw D'228' movwf Sec7 movlw D'181' movwf Sec8 movlw D'1' movwf Sec9 movlw D'30' movwf Sec10 movlw D'45' movwf Sec11 movlw D'2' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START52 movlw D'1' ; 72,03Hz movwf Sec1 ; 129,00Uн movlw D'77' ; 3105,00Hz movwf Sec2 movlw D'184' movwf Sec3 movlw D'1' movwf Sec4 movlw D'29' movwf Sec5 movlw D'232' movwf Sec6 movlw D'232' movwf Sec7 movlw D'184' movwf Sec8 movlw D'1' movwf Sec9 movlw D'30' movwf Sec10 movlw D'46' movwf Sec11 movlw D'2' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START51 movlw D'1' ; 71,05Hz movwf Sec1 ; 129,00Uн movlw D'78' ; 3055,00Hz movwf Sec2 movlw D'187' movwf Sec3 movlw D'1' movwf Sec4 movlw D'29' movwf Sec5 movlw D'236' movwf Sec6 movlw D'236' movwf Sec7 movlw D'187' movwf Sec8 movlw D'1' movwf Sec9 movlw D'30' movwf Sec10 movlw D'47' movwf Sec11 movlw D'2' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START50 movlw D'1' ; 70,00Hz movwf Sec1 ; 129,00Uн movlw D'80' ; 3015,00Hz movwf Sec2 movlw D'190' movwf Sec3 movlw D'1' movwf Sec4 movlw D'30' movwf Sec5 movlw D'239' movwf Sec6 movlw D'239' movwf Sec7 movlw D'190' movwf Sec8 movlw D'1' movwf Sec9 movlw D'31' movwf Sec10 movlw D'47' movwf Sec11 movlw D'2' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START49 movlw D'1' ; 68,98Hz movwf Sec1 ; 129,00Uн movlw D'81' ; 2962,00Hz movwf Sec2 movlw D'193' movwf Sec3 movlw D'1' movwf Sec4 movlw D'30' movwf Sec5 movlw D'244' movwf Sec6 movlw D'244' movwf Sec7 movlw D'193' movwf Sec8 movlw D'1' movwf Sec9 movlw D'31' movwf Sec10 movlw D'48' movwf Sec11 movlw D'2' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START48 movlw D'1' ; 68,03Hz movwf Sec1 ; 129,00Uн movlw D'82' ; 2920,00Hz movwf Sec2 movlw D'196' movwf Sec3 movlw D'1' movwf Sec4 movlw D'31' movwf Sec5 movlw D'247' movwf Sec6 movlw D'247' movwf Sec7 movlw D'196' movwf Sec8 movlw D'1' movwf Sec9 movlw D'32' movwf Sec10 movlw D'49' movwf Sec11 movlw D'2' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START47 movlw D'1' ; 66,98Hz movwf Sec1 ; 128,00Uн movlw D'84' ; 2873,00Hz movwf Sec2 movlw D'199' movwf Sec3 movlw D'1' movwf Sec4 movlw D'32' movwf Sec5 movlw D'251' movwf Sec6 movlw D'251' movwf Sec7 movlw D'199' movwf Sec8 movlw D'1' movwf Sec9 movlw D'33' movwf Sec10 movlw D'49' movwf Sec11 movlw D'2' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START46 movlw D'1' ; 65,98Hz movwf Sec1 ; 128,00Uн movlw D'54' ; 4412,00Hz movwf Sec2 movlw D'129' movwf Sec3 movlw D'1' movwf Sec4 movlw D'20' movwf Sec5 movlw D'162' movwf Sec6 movlw D'162' movwf Sec7 movlw D'129' movwf Sec8 movlw D'1' movwf Sec9 movlw D'21' movwf Sec10 movlw D'31' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START45 movlw D'1' ; 65,05Hz movwf Sec1 ; 128,00Uн movlw D'55' ; 4338,00Hz movwf Sec2 movlw D'131' movwf Sec3 movlw D'1' movwf Sec4 movlw D'20' movwf Sec5 movlw D'165' movwf Sec6 movlw D'165' movwf Sec7 movlw D'131' movwf Sec8 movlw D'1' movwf Sec9 movlw D'21' movwf Sec10 movlw D'32' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START44 movlw D'1' ; 64,03Hz movwf Sec1 ; 128,00Uн movlw D'56' ; 4255,00Hz movwf Sec2 movlw D'133' movwf Sec3 movlw D'1' movwf Sec4 movlw D'21' movwf Sec5 movlw D'168' movwf Sec6 movlw D'168' movwf Sec7 movlw D'133' movwf Sec8 movlw D'1' movwf Sec9 movlw D'22' movwf Sec10 movlw D'32' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START43 movlw D'1' ; 62,99Hz movwf Sec1 ; 128,00Uн movlw D'57' ; 4189,00Hz movwf Sec2 movlw D'136' movwf Sec3 movlw D'1' movwf Sec4 movlw D'21' movwf Sec5 movlw D'171' movwf Sec6 movlw D'171' movwf Sec7 movlw D'136' movwf Sec8 movlw D'1' movwf Sec9 movlw D'22' movwf Sec10 movlw D'33' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START42 movlw D'1' ; 62,03Hz movwf Sec1 ; 128,00Uн movlw D'58' ; 4125,00Hz movwf Sec2 movlw D'138' movwf Sec3 movlw D'1' movwf Sec4 movlw D'22' movwf Sec5 movlw D'174' movwf Sec6 movlw D'174' movwf Sec7 movlw D'138' movwf Sec8 movlw D'1' movwf Sec9 movlw D'22' movwf Sec10 movlw D'34' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START41 movlw D'1' ; 61,05Hz movwf Sec1 ; 128,00Uн movlw D'59' ; 4040,00Hz movwf Sec2 movlw D'141' movwf Sec3 movlw D'1' movwf Sec4 movlw D'22' movwf Sec5 movlw D'177' movwf Sec6 movlw D'177' movwf Sec7 movlw D'141' movwf Sec8 movlw D'1' movwf Sec9 movlw D'23' movwf Sec10 movlw D'34' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START40 movlw D'1' ; 60,00Hz movwf Sec1 ; 128,00Uн movlw D'60' ; 3960,00Hz movwf Sec2 movlw D'143' movwf Sec3 movlw D'1' movwf Sec4 movlw D'23' movwf Sec5 movlw D'181' movwf Sec6 movlw D'181' movwf Sec7 movlw D'143' movwf Sec8 movlw D'1' movwf Sec9 movlw D'24' movwf Sec10 movlw D'35' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START39 movlw D'1' ; 58,98Hz movwf Sec1 ; 128,00Uн movlw D'61' ; 3887,00Hz movwf Sec2 movlw D'146' movwf Sec3 movlw D'1' movwf Sec4 movlw D'23' movwf Sec5 movlw D'185' movwf Sec6 movlw D'185' movwf Sec7 movlw D'146' movwf Sec8 movlw D'1' movwf Sec9 movlw D'24' movwf Sec10 movlw D'36' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START38 movlw D'1' ; 58,04Hz movwf Sec1 ; 128,00Uн movlw D'62' ; 3824,00Hz movwf Sec2 movlw D'149' movwf Sec3 movlw D'1' movwf Sec4 movlw D'24' movwf Sec5 movlw D'188' movwf Sec6 movlw D'188' movwf Sec7 movlw D'149' movwf Sec8 movlw D'1' movwf Sec9 movlw D'24' movwf Sec10 movlw D'36' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START37 movlw D'1' ; 57,04Hz movwf Sec1 ; 128,00Uн movlw D'64' ; 3748,00Hz movwf Sec2 movlw D'152' movwf Sec3 movlw D'1' movwf Sec4 movlw D'24' movwf Sec5 movlw D'191' movwf Sec6 movlw D'191' movwf Sec7 movlw D'152' movwf Sec8 movlw D'1' movwf Sec9 movlw D'25' movwf Sec10 movlw D'37' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START36 movlw D'1' ; 56,03Hz movwf Sec1 ; 128,00Uн movlw D'65' ; 3681,00Hz movwf Sec2 movlw D'155' movwf Sec3 movlw D'1' movwf Sec4 movlw D'25' movwf Sec5 movlw D'195' movwf Sec6 movlw D'195' movwf Sec7 movlw D'155' movwf Sec8 movlw D'1' movwf Sec9 movlw D'25' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START35 movlw D'1' ; 55,01Hz movwf Sec1 ; 128,00Uн movlw D'67' ; 3599,00Hz movwf Sec2 movlw D'158' movwf Sec3 movlw D'1' movwf Sec4 movlw D'25' movwf Sec5 movlw D'199' movwf Sec6 movlw D'199' movwf Sec7 movlw D'158' movwf Sec8 movlw D'1' movwf Sec9 movlw D'26' movwf Sec10 movlw D'39' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START34 movlw D'1' ; 54,02Hz movwf Sec1 ; 128,00Uн movlw D'68' ; 3540,00Hz movwf Sec2 movlw D'161' movwf Sec3 movlw D'1' movwf Sec4 movlw D'26' movwf Sec5 movlw D'203' movwf Sec6 movlw D'203' movwf Sec7 movlw D'161' movwf Sec8 movlw D'1' movwf Sec9 movlw D'27' movwf Sec10 movlw D'40' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START33 movlw D'1' ; 53,03Hz movwf Sec1 ; 128,00Uн movlw D'69' ; 3461,00Hz movwf Sec2 movlw D'165' movwf Sec3 movlw D'1' movwf Sec4 movlw D'26' movwf Sec5 movlw D'208' movwf Sec6 movlw D'208' movwf Sec7 movlw D'165' movwf Sec8 movlw D'1' movwf Sec9 movlw D'27' movwf Sec10 movlw D'40' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START32 movlw D'1' ; 52,04Hz movwf Sec1 ; 128,00Uн movlw D'71' ; 3390,00Hz movwf Sec2 movlw D'168' movwf Sec3 movlw D'1' movwf Sec4 movlw D'27' movwf Sec5 movlw D'212' movwf Sec6 movlw D'212' movwf Sec7 movlw D'168' movwf Sec8 movlw D'1' movwf Sec9 movlw D'28' movwf Sec10 movlw D'41' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START31 movlw D'1' ; 51,04Hz movwf Sec1 ; 128,00Uн movlw D'72' ; 3320,00Hz movwf Sec2 movlw D'172' movwf Sec3 movlw D'1' movwf Sec4 movlw D'28' movwf Sec5 movlw D'216' movwf Sec6 movlw D'216' movwf Sec7 movlw D'172' movwf Sec8 movlw D'1' movwf Sec9 movlw D'29' movwf Sec10 movlw D'42' movwf Sec11 movlw D'3' movwf Sec13 bsf PortA,3 ;Индикация между 50Гц и 75Гц ;bcf SecMAX,7 lgoto ROTOR START30 movlw D'1' ; 49,70Hz----------45-75Hz vector PWM ошибка рассчёта частоты (макс. вектор) movwf Sec1 ; 128,00Uн movlw D'74' ; 3246,00Hz movwf Sec2 movlw D'176' movwf Sec3 movlw D'1' movwf Sec4 movlw D'28' movwf Sec5 movlw D'221' movwf Sec6 movlw D'221' movwf Sec7 movlw D'176' movwf Sec8 movlw D'1' movwf Sec9 movlw D'29' movwf Sec10 movlw D'43' movwf Sec11 movlw D'3' movwf Sec13 movlw .50 movwf ACCSEL ;Время паузы разгона, чтоб чётко поймать 50Гц. bcf PortA,3 bcf PortA,4 ;Индикация частоты 50Гц ;bsf SecMAX,7 lgoto ROTOR START29 movlw D'1' ; 48,66Hz movwf Sec1 ; 120,90Uн movlw D'79' ; 3164,00Hz movwf Sec2 movlw D'176' movwf Sec3 movlw D'1' movwf Sec4 movlw D'33' movwf Sec5 movlw D'222' movwf Sec6 movlw D'222' movwf Sec7 movlw D'177' movwf Sec8 movlw D'1' movwf Sec9 movlw D'36' movwf Sec10 movlw D'42' movwf Sec11 movlw D'3' movwf Sec13 bsf PortA,4 ;Индикация частоты 50Гц нет ;bcf SecMAX,7 lgoto ROTOR START28 movlw D'1' ; 47,79Hz movwf Sec1 ; 113,60Uн movlw D'84' ; 3088,00Hz movwf Sec2 movlw D'169' movwf Sec3 movlw D'8' movwf Sec4 movlw D'31' movwf Sec5 movlw D'221' movwf Sec6 movlw D'221' movwf Sec7 movlw D'179' movwf Sec8 movlw D'1' movwf Sec9 movlw D'42' movwf Sec10 movlw D'40' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START27 movlw D'1' ; 46,85Hz movwf Sec1 ; 107,80Uн movlw D'88' ; 3025,00Hz movwf Sec2 movlw D'164' movwf Sec3 movlw D'15' movwf Sec4 movlw D'30' movwf Sec5 movlw D'221' movwf Sec6 movlw D'221' movwf Sec7 movlw D'180' movwf Sec8 movlw D'1' movwf Sec9 movlw D'48' movwf Sec10 movlw D'39' movwf Sec11 movlw D'3' movwf Sec13 lgoto ROTOR START26 movlw D'1' ; 45,80Hz movwf Sec1 ; 103,40Uн movlw D'91' ; 2950,00Hz movwf Sec2 movlw D'161' movwf Sec3 movlw D'21' movwf Sec4 movlw D'30' movwf Sec5 movlw D'222' movwf Sec6 movlw D'223' movwf Sec7 movlw D'183' movwf Sec8 movlw D'1' movwf Sec9 movlw D'53' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 lgoto ROTOR START25 movlw D'6' ; 44,94Hz movwf Sec1 ; 99,00Uн movlw D'90' ; 2870,00Hz movwf Sec2 movlw D'158' movwf Sec3 movlw D'26' movwf Sec4 movlw D'29' movwf Sec5 movlw D'219' movwf Sec6 movlw D'225' movwf Sec7 movlw D'184' movwf Sec8 movlw D'1' movwf Sec9 movlw D'58' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 lgoto ROTOR START24 movlw D'9' ; 44,00Hz movwf Sec1 ; 96,82Uн movlw D'90' ; 2803,00Hz movwf Sec2 movlw D'158' movwf Sec3 movlw D'30' movwf Sec4 movlw D'29' movwf Sec5 movlw D'219' movwf Sec6 movlw D'225' movwf Sec7 movlw D'185' movwf Sec8 movlw D'3' movwf Sec9 movlw D'62' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 lgoto ROTOR START23 movlw D'13' ; 42,99Hz movwf Sec1 ; 94,60Uн movlw D'90' ; 2737,00Hz movwf Sec2 movlw D'159' movwf Sec3 movlw D'33' movwf Sec4 movlw D'29' movwf Sec5 movlw D'219' movwf Sec6 movlw D'225' movwf Sec7 movlw D'185' movwf Sec8 movlw D'7' movwf Sec9 movlw D'65' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 lgoto ROTOR START22 movlw D'17' ; 41,98Hz movwf Sec1 ; 92,30Uн movlw D'90' ; 2675,00Hz movwf Sec2 movlw D'158' movwf Sec3 movlw D'37' movwf Sec4 movlw D'29' movwf Sec5 movlw D'219' movwf Sec6 movlw D'225' movwf Sec7 movlw D'185' movwf Sec8 movlw D'11' movwf Sec9 movlw D'69' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START21 movlw D'21' ; 40,99Hz movwf Sec1 ; 89,90Uн movlw D'90' ; 2605,00Hz movwf Sec2 movlw D'158' movwf Sec3 movlw D'41' movwf Sec4 movlw D'29' movwf Sec5 movlw D'219' movwf Sec6 movlw D'225' movwf Sec7 movlw D'185' movwf Sec8 movlw D'15' movwf Sec9 movlw D'73' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START20 movlw D'25' ; 39,97Hz movwf Sec1 ; 87,50Uн movlw D'90' ; 2535,00Hz movwf Sec2 movlw D'158' movwf Sec3 movlw D'46' movwf Sec4 movlw D'29' movwf Sec5 movlw D'219' movwf Sec6 movlw D'225' movwf Sec7 movlw D'185' movwf Sec8 movlw D'19' movwf Sec9 movlw D'77' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START19 movlw D'29' ; 39,01Hz movwf Sec1 ; 85,33Uн movlw D'90' ; 2464,00Hz movwf Sec2 movlw D'159' movwf Sec3 movlw D'50' movwf Sec4 movlw D'29' movwf Sec5 movlw D'220' movwf Sec6 movlw D'225' movwf Sec7 movlw D'185' movwf Sec8 movlw D'23' movwf Sec9 movlw D'82' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START18 movlw D'34' ; 38,00Hz movwf Sec1 ; 83,10Uн movlw D'90' ; 2399,00Hz movwf Sec2 movlw D'159' movwf Sec3 movlw D'54' movwf Sec4 movlw D'29' movwf Sec5 movlw D'220' movwf Sec6 movlw D'226' movwf Sec7 movlw D'185' movwf Sec8 movlw D'28' movwf Sec9 movlw D'86' movwf Sec10 movlw D'38' movwf Sec11 movlw D'3' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START17 movlw D'29' ; 36,99Hz movwf Sec1 ; 79,62Uн movlw D'65' ; 3165,00Hz movwf Sec2 movlw D'115' movwf Sec3 movlw D'44' movwf Sec4 movlw D'21' movwf Sec5 movlw D'159' movwf Sec6 movlw D'163' movwf Sec7 movlw D'134' movwf Sec8 movlw D'25' movwf Sec9 movlw D'68' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START16 movlw D'33' ; 36,00Hz movwf Sec1 ; 77,46Uн movlw D'65' ; 3082,00Hz movwf Sec2 movlw D'115' movwf Sec3 movlw D'48' movwf Sec4 movlw D'21' movwf Sec5 movlw D'159' movwf Sec6 movlw D'163' movwf Sec7 movlw D'134' movwf Sec8 movlw D'29' movwf Sec9 movlw D'71' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START15 movlw D'37' ; 35,00Hz movwf Sec1 ; 75,30Uн movlw D'65' ; 2986,00Hz movwf Sec2 movlw D'115' movwf Sec3 movlw D'52' movwf Sec4 movlw D'21' movwf Sec5 movlw D'159' movwf Sec6 movlw D'164' movwf Sec7 movlw D'134' movwf Sec8 movlw D'33' movwf Sec9 movlw D'75' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START14 movlw D'42' ; 34,00Hz movwf Sec1 ; 72,98Uн movlw D'65' ; 2894,00Hz movwf Sec2 movlw D'115' movwf Sec3 movlw D'56' movwf Sec4 movlw D'21' movwf Sec5 movlw D'159' movwf Sec6 movlw D'164' movwf Sec7 movlw D'134' movwf Sec8 movlw D'37' movwf Sec9 movlw D'80' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START13 movlw D'46' ; 33,01Hz movwf Sec1 ; 70,66Uн movlw D'65' ; 2802,00Hz movwf Sec2 movlw D'115' movwf Sec3 movlw D'61' movwf Sec4 movlw D'21' movwf Sec5 movlw D'159' movwf Sec6 movlw D'164' movwf Sec7 movlw D'134' movwf Sec8 movlw D'42' movwf Sec9 movlw D'84' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START12 movlw D'51' ; 32,01Hz movwf Sec1 ; 68,46Uн movlw D'65' ; 2725,00Hz movwf Sec2 movlw D'115' movwf Sec3 movlw D'66' movwf Sec4 movlw D'21' movwf Sec5 movlw D'159' movwf Sec6 movlw D'163' movwf Sec7 movlw D'134' movwf Sec8 movlw D'47' movwf Sec9 movlw D'89' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START11 movlw D'56' ; 30,99Hz movwf Sec1 ; 66,38Uн movlw D'65' ; 2626,00Hz movwf Sec2 movlw D'115' movwf Sec3 movlw D'71' movwf Sec4 movlw D'21' movwf Sec5 movlw D'160' movwf Sec6 movlw D'164' movwf Sec7 movlw D'135' movwf Sec8 movlw D'52' movwf Sec9 movlw D'94' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START10 movlw D'61' ; 29,99Hz movwf Sec1 ; 64,30Uн movlw D'65' ; 2530,00Hz movwf Sec2 movlw D'116' movwf Sec3 movlw D'77' movwf Sec4 movlw D'21' movwf Sec5 movlw D'160' movwf Sec6 movlw D'165' movwf Sec7 movlw D'135' movwf Sec8 movlw D'57' movwf Sec9 movlw D'100' movwf Sec10 movlw D'27' movwf Sec11 movlw D'4' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START9 movlw D'52' ; 29,00Hz movwf Sec1 ; 62,38Uн movlw D'51' ; 3093,00Hz movwf Sec2 movlw D'91' movwf Sec3 movlw D'64' movwf Sec4 movlw D'16' movwf Sec5 movlw D'127' movwf Sec6 movlw D'130' movwf Sec7 movlw D'107' movwf Sec8 movlw D'49' movwf Sec9 movlw D'83' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START8 movlw D'57' ; 28,01Hz movwf Sec1 ; 60,46Uн movlw D'52' ; 2983,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'69' movwf Sec4 movlw D'16' movwf Sec5 movlw D'127' movwf Sec6 movlw D'131' movwf Sec7 movlw D'107' movwf Sec8 movlw D'53' movwf Sec9 movlw D'88' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 ;bcf SecMAX,7 lgoto ROTOR START7 movlw D'62' ; 26,99Hz movwf Sec1 ; 58,36Uн movlw D'52' ; 2875,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'74' movwf Sec4 movlw D'16' movwf Sec5 movlw D'128' movwf Sec6 movlw D'131' movwf Sec7 movlw D'108' movwf Sec8 movlw D'59' movwf Sec9 movlw D'93' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START6 movlw D'68' ; 26,01Hz movwf Sec1 ; 56,15Uн movlw D'52' ; 2755,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'80' movwf Sec4 movlw D'16' movwf Sec5 movlw D'128' movwf Sec6 movlw D'132' movwf Sec7 movlw D'108' movwf Sec8 movlw D'64' movwf Sec9 movlw D'99' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR ;==================================================================================== START5 movlw D'74' ; 24,98Hz movwf Sec1 ; 53,83Uн movlw D'52' ; 2642,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'87' movwf Sec4 movlw D'16' movwf Sec5 movlw D'128' movwf Sec6 movlw D'132' movwf Sec7 movlw D'108' movwf Sec8 movlw D'71' movwf Sec9 movlw D'105' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 lgoto ROTOR START4 movlw D'81' ; 23,99Hz movwf Sec1 ; 51,48Uн movlw D'52' ; 2532,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'94' movwf Sec4 movlw D'16' movwf Sec5 movlw D'128' movwf Sec6 movlw D'131' movwf Sec7 movlw D'108' movwf Sec8 movlw D'78' movwf Sec9 movlw D'112' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 lgoto ROTOR START3 movlw D'89' ; 23,00Hz movwf Sec1 ; 49,16Uн movlw D'52' ; 2423,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'101' movwf Sec4 movlw D'16' movwf Sec5 movlw D'128' movwf Sec6 movlw D'131' movwf Sec7 movlw D'107' movwf Sec8 movlw D'86' movwf Sec9 movlw D'120' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 ;bsf SecMAX,7 lgoto ROTOR START2 movlw D'97' ; 22,00Hz movwf Sec1 ; 46,96Uн movlw D'52' ; 2310,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'109' movwf Sec4 movlw D'16' movwf Sec5 movlw D'128' movwf Sec6 movlw D'131' movwf Sec7 movlw D'108' movwf Sec8 movlw D'94' movwf Sec9 movlw D'128' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 ;bcf SecMAX,7 lgoto ROTOR START1 movlw D'106' ; 20,99Hz movwf Sec1 ; 44,88Uн movlw D'52' ; 2201,00Hz movwf Sec2 movlw D'92' movwf Sec3 movlw D'118' movwf Sec4 movlw D'16' movwf Sec5 movlw D'128' movwf Sec6 movlw D'132' movwf Sec7 movlw D'108' movwf Sec8 movlw D'103' movwf Sec9 movlw D'137' movwf Sec10 movlw D'21' movwf Sec11 movlw D'5' movwf Sec13 lgoto ROTOR end