Keil uVision 5 вставка ассемблера в C код., Функция на asm не возвращается в main. Опции

[Omnicake]

Здравствуйте, уважаемые. Пытаюсь научится правильно вставлять в код на C ассемблерные функции. Взял за основу пример с включением SysTick таймера на STM32f10x. Код программы такой:

CODE

#include "stm32f10x.h"
#define F_CPU 72000000UL //Частота процессора для таймера
#define TimerTick F_CPU/1000
void Delay(uint32_t Val);
extern int systick(void);

//SysTick Interrupt
void SysTick_Handler(void)
{
// Сюда вставляется событие при срабатывании прерывания.
}

int main(void)
{
SystemInit();
//Настройка процессора
RCC->APB2ENR |= RCC_APB2ENR_IOPBEN;
GPIOB->CRL &= ~GPIO_CRL_CNF5;
GPIOB->CRL |= GPIO_CRL_MODE5_0;

systick(); //А это функция, которую я пытаюсь вставить

while(1)
{
}
}

Функция systick() имеет вид:

Код

    AREA HEAP, CODE, READONLY
    
systick        PROC
            EXPORT systick
            LDR    R0,[pc,#32]
            MOV    R1,#0xE000E000
            STR    R0,[r1,#0x14]
            STR    R0,[r1,#0x18]
            MOVS R0,#0x07
            STR    R0,[r1,#0x10]
            ENDP
            END

И представляет собой последовательность команд, которые выполнялись в дизассемблере ранее, когда таймер там вызывался через C-команды.
Проект компилируется без ошибок, но при пошаговом выполнении после команды END в systick, вываливается на HardFault_Handler, что, как я понимаю, не совсем здорово. Я предполагаю, что где-то накосячил с адресацией, но опять же, все брал из дизассемблерных команд, которые до этого нормально выполнялись. В чем моя ошибка?

Сообщение отредактировал IgorKossak - Mar 31 2014, 15:50

Причина редактирования: [codebox] для длинного кода, [code] - для короткого!!!