Форум РадиоКот

Код: Выделить всё

; -----------------------------------------------------------------------------
; Выделение области памяти под стек.
; -----------------------------------------------------------------------------

UND_STACK_SIZE  EQU     0x00000000
SVC_STACK_SIZE  EQU     0x00000008
ABT_STACK_SIZE  EQU     0x00000000
FIQ_STACK_SIZE  EQU     0x00000000
IRQ_STACK_SIZE  EQU     0x00000080
USR_STACK_SIZE  EQU     0x00000200
ISR_STACK_SIZE  EQU     (UND_STACK_SIZE + SVC_STACK_SIZE + ABT_STACK_SIZE + FIQ_STACK_SIZE + IRQ_STACK_SIZE)


                AREA    STACK, NOINIT, READWRITE, ALIGN=3

stack_limit		SPACE   USR_STACK_SIZE + ISR_STACK_SIZE
stack_base



; -----------------------------------------------------------------------------
; Выделение области памяти под кучу.
; -----------------------------------------------------------------------------

HEAP_SIZE		EQU     0x00000000


                AREA    HEAP, NOINIT, READWRITE, ALIGN=3

heap_base		SPACE   HEAP_SIZE
heap_limit



; -----------------------------------------------------------------------------
; Таблица векторов прерываний.
; -----------------------------------------------------------------------------

				PRESERVE8
                AREA    RESET, CODE, READONLY
                ARM

vectors_mem		LDR     PC, rst_addr         
				LDR     PC, und_addr
				LDR     PC, swi_addr
				LDR     PC, pab_addr
				LDR     PC, dab_addr
				NOP
				LDR     PC, [PC, #-0x0FF0]
				LDR     PC, fiq_addr

rst_addr		DCD     rst_handler
und_addr		DCD     und_handler
swi_addr		DCD     swi_handler
pab_addr		DCD     pab_handler
dab_addr		DCD     dab_handler
                DCD     0
irq_addr		DCD     irq_handler
fiq_addr		DCD     fiq_handler



; -----------------------------------------------------------------------------
; Обработчики прерываний по умолчанию.
; -----------------------------------------------------------------------------

und_handler		B       und_handler
swi_handler		B       swi_handler
pab_handler		B       pab_handler
dab_handler		B       dab_handler
irq_handler		B       irq_handler
fiq_handler		B       fiq_handler



; -----------------------------------------------------------------------------
; Обработчик прерывания reset.
; -----------------------------------------------------------------------------

MODE_USR        EQU     0x10
MODE_FIQ        EQU     0x11
MODE_IRQ        EQU     0x12
MODE_SVC        EQU     0x13
MODE_ABT        EQU     0x17
MODE_UND        EQU     0x1B
MODE_SYS        EQU     0x1F

I_BIT           EQU     0x80
F_BIT           EQU     0x40

				AREA	|.text|, CODE, READONLY
				EXPORT	rst_handler
				IMPORT	__main
				
rst_handler		
				LDR     R0, =stack_base

				MSR     CPSR_c, #MODE_UND:OR:I_BIT:OR:F_BIT
				MOV     SP, R0
				SUB     R0, R0, #UND_STACK_SIZE

                MSR     CPSR_c, #MODE_ABT:OR:I_BIT:OR:F_BIT
                MOV     SP, R0
                SUB     R0, R0, #ABT_STACK_SIZE

                MSR     CPSR_c, #MODE_FIQ:OR:I_BIT:OR:F_BIT
                MOV     SP, R0
                SUB     R0, R0, #FIQ_STACK_SIZE

                MSR     CPSR_c, #MODE_IRQ:OR:I_BIT:OR:F_BIT
                MOV     SP, R0
                SUB     R0, R0, #IRQ_STACK_SIZE

                MSR     CPSR_c, #MODE_SVC:OR:I_BIT:OR:F_BIT
                MOV     SP, R0
                SUB     R0, R0, #SVC_STACK_SIZE

                MSR     CPSR_c, #MODE_USR 
                MOV     SP, R0
                SUB     SL, SP, #USR_STACK_SIZE

                LDR     R0, =__main
                BX      R0



; -----------------------------------------------------------------------------
; Инициализация стека и кучи.
; -----------------------------------------------------------------------------

                AREA    |.text|, CODE, READONLY
                EXPORT  __user_setup_stackheap
                IMPORT	__use_two_region_memory
                
__user_setup_stackheap
                LDR     R0, =heap_base
                LDR     R1, =stack_base
                LDR     R2, =heap_limit
                LDR     R3, =stack_limit
                BX      LR
                
				END
                

Код: Выделить всё

#define DIGIT_1  (1 << PORTC3)
#define DIGIT_2  (1 << PORTC2)
#define DIGIT_3  (1 << PORTB1)
#define DIGIT_4  (1 << PORTB0)

#define SEG_A    (1<<6)
#define SEG_B    (1<<5)
#define SEG_C    (1<<0)
#define SEG_D    (1<<3)
#define SEG_E    (1<<4)
#define SEG_F    (1<<7)
#define SEG_G    (1<<1)
#define SEG_DP   (1<<2)

#define SIGN_BLANK  0
#define SIGN_8   0xFF - SEG_DP
#define SIGN_0   SIGN_8 - SEG_G
#define SIGN_1   SEG_B + SEG_C
#define SIGN_2   SIGN_8 - SEG_F - SEG_C
#define SIGN_3   SIGN_8 - SEG_F - SEG_E
#define SIGN_4   SIGN_1 + SEG_G + SEG_F
#define SIGN_6   SIGN_8 - SEG_B
#define SIGN_5   SIGN_6 - SEG_E
#define SIGN_7   SIGN_1 + SEG_A
#define SIGN_9   SIGN_8 - SEG_E

unsigned char codes[] = {SIGN_0, SIGN_1, SIGN_2, SIGN_3, SIGN_4, SIGN_5, SIGN_6, SIGN_7, SIGN_8, SIGN_9};
volatile unsigned char dispBuf[] = {SIGN_BLANK, SIGN_BLANK, SIGN_BLANK, SIGN_BLANK}, bufIndex = 0;

void setup() {                
  DDRB=(0<<DDB7) | (0<<DDB6) | (0<<DDB5) | (0<<DDB4) | (0<<DDB3) | (1<<DDB2) | (1<<DDB1) | (1<<DDB0);
  PORTB=(0<<PORTB7) | (0<<PORTB6) | (0<<PORTB5) | (0<<PORTB4) | (0<<PORTB3) | (0<<PORTB2) | (0<<PORTB1) | (0<<PORTB0);
  DDRC=(0<<DDC6) | (0<<DDC5) | (0<<DDC4) | (1<<DDC3) | (1<<DDC2) | (0<<DDC1) | (0<<DDC0);
  PORTC=(0<<PORTC6) | (0<<PORTC5) | (0<<PORTC4) | (0<<PORTC3) | (1<<PORTC2) | (0<<PORTC1) | (0<<PORTC0);
  DDRD=(1<<DDD7) | (1<<DDD6) | (1<<DDD5) | (1<<DDD4) | (1<<DDD3) | (1<<DDD2) | (1<<DDD1) | (1<<DDD0);
  PORTD=(0<<PORTD7) | (0<<PORTD6) | (0<<PORTD5) | (0<<PORTD4) | (0<<PORTD3) | (0<<PORTD2) | (0<<PORTD1) | (0<<PORTD0);
  TCCR2B=(1<<CS22) | (1<<CS20);
  TIMSK2=(1<<TOIE2);
}

void loop() {
  while(1);
}

ISR(TIMER2_OVF_vect) {
  PORTB &=  ~(DIGIT_3 | DIGIT_4);
  PORTC &=  ~(DIGIT_1 | DIGIT_2);
  if (++bufIndex == 4) bufIndex = 0; 
  PORTD = dispBuf[bufIndex];
  switch (bufIndex) {
    case 0: PORTC |= DIGIT_1;
            break;
    case 1: PORTC |= DIGIT_2;
            break;
    case 2: PORTB |= DIGIT_3;
            break;
    case 3: PORTB |= DIGIT_4;
            break;    
  }
}