Система зажигания на PIC16F876A

; Процессор --------------------------------------------------------------------------------------
LIST    p=16f876
#define PIC16F876
 
;--------------------------------------------------------------------------------------------------
;       Register Definitions
;--------------------------------------------------------------------------------------------------
 
W                            EQU     H'0000'
F                            EQU     H'0001'
 
;----- Register Files------------------------------------------------------
 
INDF                         EQU     H'0000'
TMR0                         EQU     H'0001'
PCL                          EQU     H'0002'
STATUS                       EQU     H'0003'
FSR                          EQU     H'0004'
PORTA                        EQU     H'0005'
PORTB                        EQU     H'0006'
PORTC                        EQU     H'0007'
PCLATH                       EQU     H'000A'
INTCON                       EQU     H'000B'
PIR1                         EQU     H'000C'
PIR2                         EQU     H'000D'
TMR1L                        EQU     H'000E'
TMR1H                        EQU     H'000F'
T1CON                        EQU     H'0010'
TMR2                         EQU     H'0011'
T2CON                        EQU     H'0012'
SSPBUF                       EQU     H'0013'
SSPCON                       EQU     H'0014'
CCPR1L                       EQU     H'0015'
CCPR1H                       EQU     H'0016'
CCP1CON                      EQU     H'0017'
RCSTA                        EQU     H'0018'
TXREG                        EQU     H'0019'
RCREG                        EQU     H'001A'
CCPR2L                       EQU     H'001B'
CCPR2H                       EQU     H'001C'
CCP2CON                      EQU     H'001D'
ADRESH                       EQU     H'001E'
ADCON0                       EQU     H'001F'
 
OPTION_REG                   EQU     H'0081'
TRISA                        EQU     H'0085'
TRISB                        EQU     H'0086'
TRISC                        EQU     H'0087'
PIE1                         EQU     H'008C'
PIE2                         EQU     H'008D'
PCON                         EQU     H'008E'
SSPCON2                      EQU     H'0091'
PR2                          EQU     H'0092'
SSPADD                       EQU     H'0093'
SSPSTAT                      EQU     H'0094'
TXSTA                        EQU     H'0098'
SPBRG                        EQU     H'0099'
CMCON                        EQU     H'009C'
CVRCON                       EQU     H'009D'
ADRESL                       EQU     H'009E'
ADCON1                       EQU     H'009F'
 
EEDATA                       EQU     H'010C'
EEADR                        EQU     H'010D'
EEDATH                       EQU     H'010E'
EEADRH                       EQU     H'010F'
 
EECON1                       EQU     H'018C'
EECON2                       EQU     H'018D'
 
;----- STATUS Bits --------------------------------------------------------
 
IRP                          EQU     H'0007'
RP1                          EQU     H'0006'
RP0                          EQU     H'0005'
NOT_TO                       EQU     H'0004'
NOT_PD                       EQU     H'0003'
Z                            EQU     H'0002'
DC                           EQU     H'0001'
C                            EQU     H'0000'
 
;----- INTCON Bits --------------------------------------------------------
 
GIE                          EQU     H'0007'
PEIE                         EQU     H'0006'
T0IE                         EQU     H'0005'
TMR0IE                       EQU     H'0005'
INTE                         EQU     H'0004'
RBIE                         EQU     H'0003'
T0IF                         EQU     H'0002'
TMR0IF                       EQU     H'0002'
INTF                         EQU     H'0001'
RBIF                         EQU     H'0000'
 
;----- PIR1 Bits ----------------------------------------------------------
 
ADIF                         EQU     H'0006'
RCIF                         EQU     H'0005'
TXIF                         EQU     H'0004'
SSPIF                        EQU     H'0003'
CCP1IF                       EQU     H'0002'
TMR2IF                       EQU     H'0001'
TMR1IF                       EQU     H'0000'
 
;----- PIR2 Bits ----------------------------------------------------------
 
CMIF                 EQU     H'0006'
EEIF                         EQU     H'0004'
BCLIF                        EQU     H'0003'
CCP2IF                       EQU     H'0000'
 
;----- T1CON Bits ---------------------------------------------------------
 
T1CKPS1                      EQU     H'0005'
T1CKPS0                      EQU     H'0004'
T1OSCEN                      EQU     H'0003'
NOT_T1SYNC                   EQU     H'0002'
T1INSYNC                     EQU     H'0002'    ; Backward compatibility only
T1SYNC                       EQU     H'0002'
TMR1CS                       EQU     H'0001'
TMR1ON                       EQU     H'0000'
 
;----- T2CON Bits ---------------------------------------------------------
 
TOUTPS3                      EQU     H'0006'
TOUTPS2                      EQU     H'0005'
TOUTPS1                      EQU     H'0004'
TOUTPS0                      EQU     H'0003'
TMR2ON                       EQU     H'0002'
T2CKPS1                      EQU     H'0001'
T2CKPS0                      EQU     H'0000'
 
;----- SSPCON Bits --------------------------------------------------------
 
WCOL                         EQU     H'0007'
SSPOV                        EQU     H'0006'
SSPEN                        EQU     H'0005'
CKP                          EQU     H'0004'
SSPM3                        EQU     H'0003'
SSPM2                        EQU     H'0002'
SSPM1                        EQU     H'0001'
SSPM0                        EQU     H'0000'
 
;----- CCP1CON Bits -------------------------------------------------------
 
CCP1X                        EQU     H'0005'
CCP1Y                        EQU     H'0004'
CCP1M3                       EQU     H'0003'
CCP1M2                       EQU     H'0002'
CCP1M1                       EQU     H'0001'
CCP1M0                       EQU     H'0000'
 
;----- RCSTA Bits ---------------------------------------------------------
 
SPEN                         EQU     H'0007'
RX9                          EQU     H'0006'
RC9                          EQU     H'0006'    ; Backward compatibility only
NOT_RC8                      EQU     H'0006'    ; Backward compatibility only
RC8_9                        EQU     H'0006'    ; Backward compatibility only
SREN                         EQU     H'0005'
CREN                         EQU     H'0004'
ADDEN                        EQU     H'0003'
FERR                         EQU     H'0002'
OERR                         EQU     H'0001'
RX9D                         EQU     H'0000'
RCD8                         EQU     H'0000'    ; Backward compatibility only
 
;----- CCP2CON Bits -------------------------------------------------------
 
CCP2X                        EQU     H'0005'
CCP2Y                        EQU     H'0004'
CCP2M3                       EQU     H'0003'
CCP2M2                       EQU     H'0002'
CCP2M1                       EQU     H'0001'
CCP2M0                       EQU     H'0000'
 
;----- ADCON0 Bits --------------------------------------------------------
 
ADCS1                        EQU     H'0007'
ADCS0                        EQU     H'0006'
CHS2                         EQU     H'0005'
CHS1                         EQU     H'0004'
CHS0                         EQU     H'0003'
GO                           EQU     H'0002'
NOT_DONE                     EQU     H'0002'
GO_DONE                      EQU     H'0002'
ADON                         EQU     H'0000'
 
;----- OPTION_REG Bits -----------------------------------------------------
 
NOT_RBPU                     EQU     H'0007'
INTEDG                       EQU     H'0006'
T0CS                         EQU     H'0005'
T0SE                         EQU     H'0004'
PSA                          EQU     H'0003'
PS2                          EQU     H'0002'
PS1                          EQU     H'0001'
PS0                          EQU     H'0000'
 
;----- PIE1 Bits ----------------------------------------------------------
 
ADIE                         EQU     H'0006'
RCIE                         EQU     H'0005'
TXIE                         EQU     H'0004'
SSPIE                        EQU     H'0003'
CCP1IE                       EQU     H'0002'
TMR2IE                       EQU     H'0001'
TMR1IE                       EQU     H'0000'
 
;----- PIE2 Bits ----------------------------------------------------------
 
CMIE                 EQU     H'0006'
EEIE                         EQU     H'0004'
BCLIE                        EQU     H'0003'
CCP2IE                       EQU     H'0000'
 
;----- PCON Bits ----------------------------------------------------------
 
NOT_POR                      EQU     H'0001'
NOT_BO                       EQU     H'0000'
NOT_BOR                      EQU     H'0000'
 
;----- SSPCON2 Bits --------------------------------------------------------
 
GCEN                         EQU     H'0007'
ACKSTAT                      EQU     H'0006'
ACKDT                        EQU     H'0005'
ACKEN                        EQU     H'0004'
RCEN                         EQU     H'0003'
PEN                          EQU     H'0002'
RSEN                         EQU     H'0001'   
SEN                          EQU     H'0000'   
 
;----- SSPSTAT Bits -------------------------------------------------------
 
SMP                          EQU     H'0007'
CKE                          EQU     H'0006'
D                            EQU     H'0005'
I2C_DATA                     EQU     H'0005'
NOT_A                        EQU     H'0005'
NOT_ADDRESS                  EQU     H'0005'
D_A                          EQU     H'0005'
DATA_ADDRESS                 EQU     H'0005'
P                            EQU     H'0004'
I2C_STOP                     EQU     H'0004'
S                            EQU     H'0003'
I2C_START                    EQU     H'0003'
R                            EQU     H'0002'
I2C_READ                     EQU     H'0002'
NOT_W                        EQU     H'0002'
NOT_WRITE                    EQU     H'0002'
R_W                          EQU     H'0002'
READ_WRITE                   EQU     H'0002'
UA                           EQU     H'0001'
BF                           EQU     H'0000'
 
;----- TXSTA Bits ---------------------------------------------------------
 
CSRC                         EQU     H'0007'
TX9                          EQU     H'0006'
NOT_TX8                      EQU     H'0006'    ; Backward compatibility only
TX8_9                        EQU     H'0006'    ; Backward compatibility only
TXEN                         EQU     H'0005'
SYNC                         EQU     H'0004'
BRGH                         EQU     H'0002'
TRMT                         EQU     H'0001'
TX9D                         EQU     H'0000'
TXD8                         EQU     H'0000'    ; Backward compatibility only
 
 
;----- CMCON Bits ---------------------------------------------------------
C2OUT                        EQU     H'0007'
C1OUT                        EQU     H'0006'
C2INV                        EQU     H'0005'
C1INV                        EQU     H'0004'
CIS                          EQU     H'0003'
CM2                          EQU     H'0002'
CM1                          EQU     H'0001'
CM0                          EQU     H'0000'
 
;----- CVRCON Bits --------------------------------------------------------
CVREN                        EQU     H'0007'
CVROE                        EQU     H'0006'
CVRR                         EQU     H'0005'
CVR3                         EQU     H'0003'
CVR2                         EQU     H'0002'
CVR1                         EQU     H'0001'
CVR0                         EQU     H'0000'
 
;----- ADCON1 Bits --------------------------------------------------------
 
ADFM                         EQU     H'0007'
ADCS2                        EQU     H'0006'
PCFG3                        EQU     H'0003'
PCFG2                        EQU     H'0002'
PCFG1                        EQU     H'0001'
PCFG0                        EQU     H'0000'
 
;----- EECON1 Bits --------------------------------------------------------
 
EEPGD                        EQU     H'0007'
WRERR                        EQU     H'0003'
WREN                         EQU     H'0002'
WR                           EQU     H'0001'
RD                           EQU     H'0000'
 
;==========================================================================
;
;       RAM Definition
;
;==========================================================================
 
        __MAXRAM H'1FF'
        __BADRAM H'8F'-H'90', H'95'-H'97', H'9A'-H'9B'
        __BADRAM H'105', H'107'-H'109'
        __BADRAM H'185', H'187'-H'189', H'18E'-H'18F'
 
;==========================================================================
;
;       Configuration Bits
;
;==========================================================================
 
_CP_ALL                      EQU     H'1FFF'
_CP_OFF                      EQU     H'3FFF'
_DEBUG_OFF                   EQU     H'3FFF'
_DEBUG_ON                    EQU     H'37FF'
_WRT_OFF                     EQU     H'3FFF'    ; No prog memmory write protection
_WRT_256                     EQU     H'3DFF'    ; First 256 prog memmory write protected
_WRT_1FOURTH                 EQU     H'3BFF'    ; First quarter prog memmory write protected
_WRT_HALF                    EQU     H'39FF'    ; First half memmory write protected
_CPD_OFF                     EQU     H'3FFF'
_CPD_ON                      EQU     H'3EFF'
_LVP_ON                      EQU     H'3FFF'
_LVP_OFF                     EQU     H'3F7F'
_BODEN_ON                    EQU     H'3FFF'
_BODEN_OFF                   EQU     H'3FBF'
_PWRTE_OFF                   EQU     H'3FFF'
_PWRTE_ON                    EQU     H'3FF7'
_WDT_ON                      EQU     H'3FFF'
_WDT_OFF                     EQU     H'3FFB'
_RC_OSC                      EQU     H'3FFF'
_HS_OSC                      EQU     H'3FFE'
_XT_OSC                      EQU     H'3FFD'
_LP_OSC                      EQU     H'3FFC'
 
; Конфигурация ------------------------------------------------------------------------------------
 
    __config _CP_OFF & _BODEN_OFF & _PWRTE_OFF & _WDT_OFF & _XT_OSC & _LVP_OFF
    
;------------------------------------------------------------------
jz  macro   LBL ;переход, если результат равен нулю
    btfsc   STATUS,Z
    goto    LBL
    endm
jnz macro   LBL ;переход, если результат не равен нулю
    btfss   STATUS,Z
    goto    LBL
    endm
bank0   macro
        bcf     STATUS,RP0
    bcf STATUS,RP1
        endm
bank1   macro
        bsf     STATUS,RP0
    bcf STATUS,RP1
        endm
bank2   macro
        bcf     STATUS,RP0
    bsf STATUS,RP1
        endm
bank3   macro
        bsf     STATUS,RP0
    bsf STATUS,RP1
        endm
let macro   aa,bb   ;присвоить регистру aa значение bb (через W)
    movlw   bb
    movwf   aa
    endm
;------------------------------------------------------------------
    cblock  10
w_temp,status_temp,pclath_temp,fsr_temp
zzh,zzl,ob1,tmr,vak,ob,st,zl,str,rxx
    endc
;------------------------------------------------------------------
    org 0
    goto    start
;------------------------------------------------------------------
        org     4
    btfsc   INTCON,T0IF
    goto    t0
    btfsc   INTCON,INTF
    goto    ign
;------------------------------------------------------------------ 
t0  incf    ob1,F
    movlw   2
    xorwf   ob1,W
    jnz t1
    decf    ob1,F
    movlw   0ff
    movwf   TMR0
t1  bcf INTCON,T0IF
    retfie
;------------------------------------------------------------------ 
ign movfw   TMR0
    movwf   tmr
    clrf    TMR0
 
    btfss   INTCON,T0IF ;проверяем флаг TMR0
    goto    ign1        ;не установлен - по метке
 
    bcf INTCON,T0IF ;установлен - сбрасываем,
    movf    tmr,F       ;проверяем, что записалось в tmr
    jnz ign1        ;если не 0 - идем по метке
    movlw   1       ;иначе ob1=1
    movwf   ob1
 
ign1    call    ob_min      ;меряем обороты
    movwf   ob
;------------------------------------------------------------   
;вычисляем расход воздуха, в vak записываем старший адрес нужной
;таблицы опережения (0ah - 019h) 10 - 25
    btfsc   ADCON0,GO
    goto    kl0
    movfw   ADRESH
    bsf ADCON0,GO
    call    dad
    movwf   vak
;------------------------------------------------------------
kl0 btfsc   PORTB,7     ;концевик разомкнут?
    goto    kl3     ;да - по метке
 
kl1 movlw   d'21'       ;выше 2100 ? 
    subwf   ob,W
    btfsc   STATUS,C
    bcf PORTC,5     ;выключаем клапан
    
kl2 movlw   d'19'       ;ниже 1900 ?
    subwf   ob,W
    btfss   STATUS,C    
kl3 bsf PORTC,5     ;включаем клапан
;------------------------------------------------------------
tm0 movf    ob,F        ;обороты меньше 600?
    jnz tm1     ;нет - по метке
    btfsc   str,0       ;флаг стартера сброшен?
    goto    tm01        ;нет - по метке
    let ob,6        ;да - уст. обороты 600
    goto    tm11        ;и идем дальше
tm01    clrf    st      ;обнуляем счетчик об. стартера
    let zzh,03      ;ставим максимальную задержку
    let zzl,0ff
    call    zader
    bsf PORTC,6     ;импульс зажигания
    movlw   20
    movwf   tmr 
    call    zadimp
    bcf PORTC,6
    movlw   20
    movwf   tmr 
    call    zadimp
    bsf PORTC,6     ;импульс зажигания
    movlw   20
    movwf   tmr 
    call    zadimp
    bcf PORTC,6
    movlw   20
    movwf   tmr 
    call    zadimp
    bsf PORTC,6     ;импульс зажигания
    movlw   20
    movwf   tmr 
    call    zadimp
    bcf PORTC,6
    movlw   20
    movwf   tmr 
    call    zadimp
    bsf PORTC,6     ;импульс зажигания
    movlw   20
    movwf   tmr 
    call    zadimp
    bcf PORTC,6
    movlw   20
    movwf   tmr 
    call    zadimp
    bsf PORTC,6     ;импульс зажигания
    movlw   20
    movwf   tmr 
    call    zadimp
    bcf PORTC,6
    clrf    ob1
    bcf     INTCON,INTF     ;сброс флага прерывания
    retfie                  ;выходим
;------------------------------------------------------------
tm1 incf    st,F
    btfss   st,2
    goto    tm11
    bcf PORTC,4     ;выкл. стартер
    bcf str,0       ;сброс флага стартера
;-----------------------
tm11    btfss   PORTB,7     ;концевик замкнут ?
    goto    xx1     ;да - на регулировку хх
tm  movlw   1
    movwf   zl
;-----------------------
    movfw   ob
    call    op_z        ;вычисляем задержку зажигания
tm2 call    zader       ;задержка зажигания
    bsf PORTC,6     ;импульс зажигания
    btfss   ob1,0
    goto    tm3
    movlw   0ff
    movwf   tmr 
tm3 call    zadimp      ;равный трети паузы
    bcf PORTC,6
    clrf    ob1
    bcf     INTCON,INTF     ;сброс флага прерывания
    retfie                  ;выходим
;------------------------------------------------------------
xx1 movlw   d'15'       ;выше 1500 ?
    subwf   ob,W
    btfsc   STATUS,C
    bcf     rxx,0       ;сбрасываем флаг хх
    movlw   d'14'       ;ниже 1400 ?
    subwf   ob,W
    btfss   STATUS,C
    bsf rxx,0       ;устанавливаем флаг хх
 
    btfss   rxx,0       ;флаг хх установлен?
    goto    tm      ;нет - по метке
 
    movlw   d'8'        ;выше 800 ? 
    subwf   ob,W
    btfss   STATUS,C
    goto    xx2     ;нет - по метке
    incf    zl,F        ;да - уменьшаем опережение
    btfsc   STATUS,Z
    decf    zl,F
    goto    xx3
xx2 decf    zl,F        ;увеличиваем опережение
    btfsc   STATUS,Z
    incf    zl,F
xx3 movlw   1
    movwf   zzh 
    movfw   zl
    movwf   zzl
    goto    tm2     
;------------------------------------------------------------------
;           Программа
;------------------------------------------------------------------
start   bank1
    let TRISA,b'00000001'
    let TRISB,b'10000001'
    let TRISC,b'00000000'
        let OPTION_REG,b'10000110'
    let ADCON1,b'00001110'
    bank0
    let ADCON0,b'00000001'
    bsf     INTCON,INTE     ;разрешение прерывания от INT
    bsf INTCON,T0IE
        bsf     INTCON,GIE      ;разрешаем прерывания
    let vak,d'10'   ;расход - минимальный
    let zl,1        ;хх - на максимум
    bsf str,0       ;уст. флаг стартера
    let PORTC,b'00110000' ;клапан и стартер вкл.
    clrf    ob1
 
m1  goto    m1
;------------------------------------------------------------------
;           ПОДПРОГРАММЫ
;------------------------------------------------------------------
ob_min  ;перевод tmr в обороты
    ;вход: ob1:tmr
    ;выход: W
    movfw   ob1
    bank2
    movwf   EEADRH
    movlw   8
    addwf   EEADRH,F
    bank0
    movfw   tmr
    bank2
    movwf   EEADR
    
    bank3
    bsf EECON1,EEPGD
    bsf EECON1,RD
    nop
    nop
    bank2
    movfw   EEDATA
    bank0
    return
;---------------------------------------------------------
op_z    ;перевод оборотов в задержку зажигания
    ;вход: vak:W
    ;выход: zzh:zzl
    bank2
    movwf   EEADR
    bank0
    movfw   vak
    bank2
    movwf   EEADRH
    
    bank3
    bsf EECON1,EEPGD
    bsf EECON1,RD
    nop
    nop
    bank2
    movfw   EEDATA
    bank0
    movwf   zzl
    bank2
    movfw   EEDATH
    bank0
    movwf   zzh
    return
;------------------------------------------------------------------
zader   incf    zzh,F       ;задержка зажигания 16 мкс * zzh:zzl
zader1  nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    decfsz  zzl,F
    goto    zader1
    decfsz  zzh,F
    goto    zader1
    return
 
zadimp  nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    nop
    decfsz  tmr,F
    goto    zadimp
    return
;-------------------------------------------------------------------------------------------------------------
    org 1fc
dad clrf    PCLATH
    incf    PCLATH,F
    incf    PCLATH,F
    addwf   PCL,F
 
    dt  d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10'
    dt  d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10'
    dt  d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10'
    dt  d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10'
 
    dt  d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11'
    dt  d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12'
    dt  d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13'
    dt  d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14'
    dt  d'15',d'15',d'15',d'15',d'15',d'15',d'15',d'15',d'15',d'15',d'15',d'15'
    dt  d'16',d'16',d'16',d'16',d'16',d'16',d'16',d'16',d'16',d'16',d'16',d'16'
    dt  d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'17'
    dt  d'18',d'18',d'18',d'18',d'18',d'18',d'18',d'18',d'18',d'18',d'18',d'18'
    dt  d'19',d'19',d'19',d'19',d'19',d'19',d'19',d'19',d'19',d'19',d'19',d'19'
    dt  d'20',d'20',d'20',d'20',d'20',d'20',d'20',d'20',d'20',d'20',d'20',d'20'
    dt  d'21',d'21',d'21',d'21',d'21',d'21',d'21',d'21',d'21',d'21',d'21',d'21'
    dt  d'22',d'22',d'22',d'22',d'22',d'22',d'22',d'22',d'22',d'22',d'22',d'22'
    dt  d'23',d'23',d'23',d'23',d'23',d'23',d'23',d'23',d'23',d'23',d'23',d'23'
    dt  d'24',d'24',d'24',d'24',d'24',d'24',d'24',d'24',d'24',d'24',d'24',d'24'
 
    dt  d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25'
    dt  d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25',d'25'
    
    org 300
    dt  0ff
;-------------------------------------------------------------------------------------------------------------
    org 800     ;обороты дв./100
    dw  d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50'
    dw  d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50'
    dw  d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'50',d'49'
    dw  d'48',d'47',d'46',d'45',d'44',d'43',d'43',d'42',d'41',d'40',d'40',d'39',d'38',d'38',d'37',d'37'
    dw  d'36',d'36',d'35',d'34',d'34',d'33',d'33',d'33',d'32',d'32',d'31',d'31',d'30',d'30',d'30',d'29'
    dw  d'29',d'29',d'28',d'28',d'28',d'27',d'27',d'27',d'26',d'26',d'26',d'25',d'25',d'25',d'25',d'24'
    dw  d'24',d'24',d'24',d'23',d'23',d'23',d'23',d'23',d'22',d'22',d'22',d'22',d'22',d'21',d'21',d'21'
    dw  d'21',d'21',d'20',d'20',d'20',d'20',d'20',d'20',d'19',d'19',d'19',d'19',d'19',d'19',d'18',d'18'
    dw  d'18',d'18',d'18',d'18',d'18',d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'17',d'16',d'16'
    dw  d'16',d'16',d'16',d'16',d'16',d'16',d'16',d'15',d'15',d'15',d'15',d'15',d'15',d'15',d'15',d'15'
    dw  d'15',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'14',d'13',d'13',d'13'
    dw  d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'13',d'12',d'12',d'12',d'12',d'12'
    dw  d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'12',d'11',d'11',d'11',d'11',d'11'
    dw  d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'11',d'10'
    dw  d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10',d'10'
    dw  d'10',d'10',d'10',d'10',d'10',d'10',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9'
    dw  d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9',d'9'
    dw  d'9',d'9',d'9',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8'
    dw  d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8'
    dw  d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'8',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7'
    dw  d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7'
    dw  d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7'
    dw  d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'7',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6'
    dw  d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'6',d'0'
;------------------------------------------------------------------
    ;maxungle = 40.5 
    org 0a06
    dw  d'515',d'422',d'348',d'292',d'248',d'209',d'177',d'149',d'126',d'105',d'88',d'74',d'64',d'55',d'48'
    dw  d'42',d'38',d'33',d'30',d'28',d'26',d'24',d'22',d'21',d'19',d'18',d'17',d'16',d'15',d'15'
    dw  d'14',d'13',d'12',d'12',d'11',d'10',d'9',d'9',d'8',d'7',d'7',d'7',d'6',d'6',d'6'
    org 0b06
    dw  d'489',d'394',d'322',d'264',d'217',d'184',d'154',d'127',d'104',d'88',d'73',d'62',d'52',d'44',d'38'
    dw  d'34',d'31',d'28',d'26',d'24',d'22',d'20',d'19',d'18',d'17',d'16',d'16',d'15',d'14',d'13'
    dw  d'12',d'12',d'11',d'10',d'9',d'9',d'8',d'7',d'7',d'6',d'6',d'5',d'5',d'5',d'4'
    org 0c06
    dw  d'446',d'356',d'294',d'246',d'206',d'171',d'143',d'120',d'100',d'83',d'68',d'56',d'46',d'38',d'33'
    dw  d'30',d'27',d'24',d'22',d'21',d'19',d'18',d'16',d'15',d'14',d'13',d'12',d'12',d'11',d'11'
    dw  d'10',d'10',d'9',d'9',d'8',d'7',d'7',d'6',d'5',d'5',d'4',d'4',d'3',d'3',d'3'
    org 0d06
    dw  d'428',d'342',d'285',d'242',d'206',d'174',d'146',d'119',d'97',d'81',d'67',d'55',d'44',d'34',d'28'
    dw  d'25',d'22',d'19',d'18',d'17',d'16',d'16',d'15',d'13',d'12',d'12',d'11',d'10',d'9',d'9'
    dw  d'8',d'7',d'7',d'6',d'6',d'5',d'5',d'4',d'4',d'4',d'3',d'3',d'2',d'2',d'2'
    org 0e06
    dw  d'437',d'349',d'292',d'248',d'212',d'182',d'154',d'127',d'104',d'86',d'71',d'58',d'48',d'39',d'32'
    dw  d'28',d'25',d'22',d'20',d'19',d'18',d'18',d'16',d'15',d'13',d'12',d'11',d'10',d'9',d'9'
    dw  d'8',d'7',d'7',d'6',d'5',d'5',d'4',d'4',d'3',d'3',d'2',d'2',d'1',d'1',d'1'
    org 0f06
    dw  d'454',d'358',d'303',d'257',d'217',d'186',d'159',d'133',d'111',d'95',d'80',d'67',d'57',d'47',d'41'
    dw  d'37',d'34',d'31',d'29',d'27',d'25',d'23',d'22',d'20',d'18',d'17',d'16',d'15',d'14',d'13'
    dw  d'12',d'12',d'11',d'10',d'9',d'8',d'7',d'6',d'6',d'5',d'4',d'4',d'3',d'3',d'3'
    org 1006
    dw  d'507',d'396',d'331',d'280',d'238',d'202',d'172',d'145',d'123',d'107',d'92',d'80',d'70',d'60',d'53'
    dw  d'48',d'44',d'40',d'37',d'35',d'33',d'31',d'29',d'27',d'25',d'24',d'22',d'21',d'19',d'18'
    dw  d'17',d'16',d'15',d'14',d'13',d'12',d'12',d'11',d'10',d'10',d'9',d'8',d'7',d'6',d'6'
    org 1106
    dw  d'559',d'441',d'370',d'315',d'269',d'228',d'195',d'168',d'145',d'127',d'112',d'98',d'84',d'72',d'63'
    dw  d'57',d'52',d'47',d'44',d'41',d'39',d'37',d'35',d'33',d'31',d'29',d'27',d'25',d'24',d'23'
    dw  d'22',d'20',d'19',d'18',d'17',d'16',d'15',d'15',d'14',d'13',d'12',d'11',d'11',d'10',d'9'
    org 1206
    dw  d'593',d'483',d'409',d'352',d'305',d'264',d'229',d'197',d'171',d'149',d'129',d'112',d'97',d'83',d'74'
    dw  d'67',d'61',d'56',d'53',d'50',d'47',d'45',d'42',d'40',d'38',d'35',d'34',d'32',d'30',d'28'
    dw  d'26',d'25',d'23',d'22',d'21',d'20',d'19',d'18',d'17',d'16',d'16',d'15',d'14',d'14',d'13'
    org 1306
    dw  d'611',d'516',d'441',d'381',d'332',d'291',d'255',d'221',d'193',d'168',d'146',d'128',d'112',d'97',d'86'
    dw  d'78',d'71',d'65',d'61',d'58',d'55',d'52',d'50',d'47',d'45',d'42',d'40',d'38',d'36',d'35'
    dw  d'33',d'32',d'30',d'29',d'28',d'26',d'25',d'24',d'23',d'22',d'21',d'21',d'20',d'19',d'19'
    org 1406
    dw  d'628',d'538',d'461',d'396',d'342',d'300',d'265',d'237',d'212',d'187',d'165',d'146',d'129',d'114',d'102'
    dw  d'92',d'84',d'76',d'72',d'67',d'64',d'60',d'57',d'55',d'52',d'50',d'48',d'46',d'44',d'43'
    dw  d'41',d'40',d'38',d'37',d'35',d'34',d'33',d'32',d'30',d'29',d'28',d'27',d'27',d'26',d'25'
    org 1506
    dw  d'645',d'546',d'463',d'401',d'353',d'315',d'283',d'253',d'227',d'204',d'184',d'165',d'148',d'132',d'120'
    dw  d'110',d'101',d'92',d'86',d'80',d'75',d'70',d'66',d'63',d'60',d'57',d'55',d'53',d'51',d'49'
    dw  d'47',d'45',d'44',d'42',d'41',d'40',d'38',d'37',d'36',d'35',d'34',d'33',d'32',d'32',d'31'
    org 1606
    dw  d'663',d'555',d'474',d'412',d'364',d'325',d'291',d'261',d'235',d'214',d'195',d'178',d'161',d'146',d'133'
    dw  d'122',d'112',d'103',d'96',d'90',d'84',d'78',d'74',d'70',d'67',d'64',d'61',d'59',d'56',d'54'
    dw  d'52',d'50',d'48',d'46',d'45',d'43',d'41',d'40',d'39',d'37',d'36',d'35',d'35',d'34',d'33'
    org 1706
    dw  d'663',d'561',d'476',d'417',d'373',d'328',d'293',d'266',d'243',d'221',d'202',d'184',d'168',d'153',d'141'
    dw  d'130',d'119',d'110',d'103',d'96',d'90',d'84',d'79',d'74',d'69',d'65',d'61',d'59',d'56',d'54'
    dw  d'52',d'50',d'48',d'46',d'45',d'43',d'41',d'40',d'39',d'37',d'36',d'35',d'35',d'34',d'33'
    org 1806
    dw  d'663',d'561',d'485',d'424',d'374',d'331',d'297',d'270',d'247',d'226',d'208',d'190',d'174',d'159',d'146'
    dw  d'136',d'126',d'117',d'109',d'101',d'94',d'88',d'82',d'77',d'73',d'69',d'65',d'62',d'59',d'56'
    dw  d'54',d'52',d'49',d'48',d'46',d'45',d'43',d'42',d'41',d'40',d'39',d'38',d'37',d'36',d'35'
    org 1906
    dw  d'663',d'561',d'485',d'426',d'379',d'336',d'301',d'274',d'250',d'228',d'208',d'191',d'175',d'161',d'149'
    dw  d'138',d'128',d'119',d'111',d'103',d'96',d'90',d'84',d'80',d'76',d'72',d'68',d'65',d'62',d'59'
    dw  d'57',d'54',d'52',d'50',d'49',d'47',d'46',d'44',d'43',d'42',d'41',d'40',d'39',d'38',d'37'
;------------------------------------------------------------------
    end

ob_min  ;перевод tmr в обороты
    ;вход: ob1:tmr
    ;выход: W
    movfw   ob1
    bank2
    movwf   EEADRH
    movlw   8
    addwf   EEADRH,F
    bank0
    movfw   tmr
    bank2
    movwf   EEADR
    
    bank3
    bsf EECON1,EEPGD
    bsf EECON1,RD
    nop
    nop
    bank2
    movfw   EEDATA
    bank0
    return