.ORG 0x0
    jmp MAIN
.ORG 0x1C
    jmp TIMER0_COMPA
.ORG 0x1E
    jmp TIMER0_COMPB


; 16 MHz / 1024 (prescaler) = 15625 Hz clock
; 15625 Hz / 100 Hz = 156.25 value for period
; 15625 Hz / 1000 Hz = 16 value for period



MAIN:
    LDI R20,HIGH(RaMEND)
    OUT SPH,R20
    LDI R20,LOW(RAMEND)
    OUT SPL,R20
    sbi DDRB,1

    ldi r20,16
    out OCR0A,r20

    ldi r20,10
    out OCR0b,r20

    LDI r20,(1<<WGM01)
    OUT TCCR0A,r20
    ldi r20,0b00000101;0x01
    out TCCR0B,R20
    LDI r20,(1<<OCIE0A | 1<<OCIE0B)
    sts TIMSK0,r20
    SEI

    LDI r20,0x00
    out DDRC,r20
    LDI r20,0xff
    out DDRD,r20

HERE:
nop
nop
jmp HERE

TIMER0_COMPA:
        in  r16, PORTB
        sbr r16, 0b00000010
        out PORTB, r16
        reti

TIMER0_COMPB:

        in  r16, PORTB
        cbr r16, 0b00000010
        out PORTB, r16
        reti