Sojus07/hackrf
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
hackrf/firmware/startup_systick/startup_systick.c

326 lines
7.4 KiB
C
Raw Blame History

/*
* Copyright 2010 - 2012 Michael Ossmann
*
* This file is part of HackRF.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2, or (at your option)
* any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; see the file COPYING. If not, write to
* the Free Software Foundation, Inc., 51 Franklin Street,
* Boston, MA 02110-1301, USA.
*/
#include <libopencm3/lpc43xx/gpio.h>
#include <libopencm3/lpc43xx/scu.h>
#include <libopencm3/lpc43xx/i2c.h>
#include <libopencm3/lpc43xx/nvic.h>
#include <libopencm3/lpc43xx/systick.h>
#include <libopencm3/cm3/scs.h>
#include "hackrf_core.h"
/* Global counter incremented by SysTick Interrupt each millisecond */
volatile u32 g_ulSysTickCount;
u32 g_NbCyclePerSecond;
void gpio_setup(void)
{
/* Configure SCU Pin Mux as GPIO */
scu_pinmux(SCU_PINMUX_LED1, SCU_GPIO_FAST);
scu_pinmux(SCU_PINMUX_LED2, SCU_GPIO_FAST);
scu_pinmux(SCU_PINMUX_LED3, SCU_GPIO_FAST);
scu_pinmux(SCU_PINMUX_EN1V8, SCU_GPIO_FAST);
/* Configure all GPIO as Input (safe state) */
GPIO0_DIR = 0;
GPIO1_DIR = 0;
GPIO2_DIR = 0;
GPIO3_DIR = 0;
GPIO4_DIR = 0;
GPIO5_DIR = 0;
GPIO6_DIR = 0;
GPIO7_DIR = 0;
/* Configure GPIO2[1/2/8] (P4_1/2 P6_12) as output. */
GPIO2_DIR |= (PIN_LED1|PIN_LED2|PIN_LED3);
/* GPIO3[6] on P6_10 as output. */
GPIO3_DIR |= PIN_EN1V8;
}
void systick_setup(void)
{
u32 systick_reload_val;
g_ulSysTickCount = 0;
/* Disable IRQ globally */
asm volatile ("cpsid i");
/* Set processor Clock as Source Clock */
systick_set_clocksource(STK_CTRL_CLKSOURCE);
/* Get SysTick calibration value to obtain by default 1 tick = 10ms */
systick_reload_val = systick_get_calib();
/*
* Calibration seems wrong on LPC43xx(TBC) for default Freq it assume System Clock is 12MHz but it is 12*17=204MHz
* Fix the Calibration value bu multiplication by 17
*/
systick_reload_val = (systick_reload_val*17);
/* To obtain 1ms per tick just divide by 10 the 10ms base tick and set the reload */
systick_reload_val = systick_reload_val/10;
systick_set_reload(systick_reload_val);
systick_interrupt_enable();
/* Start counting. */
systick_counter_enable();
/* Set SysTick Priority to maximum */
nvic_set_priority(NVIC_SYSTICK_IRQ, 0xFF);
/* Enable IRQ globally */
asm volatile ("cpsie i");
}
void scs_dwt_cycle_counter_enabled(void)
{
SCS_DEMCR |= SCS_DEMCR_TRCENA;
SCS_DWT_CTRL |= SCS_DWT_CTRL_CYCCNTENA;
}
u32 sys_tick_get_time_ms(void)
{
return g_ulSysTickCount;
}
u32 sys_tick_delta_time_ms(u32 start, u32 end)
{
#define MAX_T_U32 ((2^32)-1)
u32 diff;
if(end > start)
{
diff=end-start;
}else
{
diff=MAX_T_U32-(start-end)+1;
}
return diff;
}
void sys_tick_wait_time_ms(u32 wait_ms)
{
u32 start, end;
u32 tickms;
start = sys_tick_get_time_ms();
do
{
end = sys_tick_get_time_ms();
tickms = sys_tick_delta_time_ms(start, end);
}while(tickms < wait_ms);
}
/* Called each 1ms/1000Hz by interrupt
1) Count the number of cycle per second.
2) Increment g_ulSysTickCount counter.
*/
void sys_tick_handler(void)
{
if(g_ulSysTickCount==0)
{
/* Clear Cycle Counter*/
SCS_DWT_CYCCNT = 0;
}else if(g_ulSysTickCount==1000)
{
/* Capture number of cycle elapsed during 1 second */
g_NbCyclePerSecond = SCS_DWT_CYCCNT;
}
g_ulSysTickCount++;
}
u32 test_nb_instruction_per_sec(void)
{
u32 start, end, wait_ms;
u32 tickms;
u32 nb_instructions_per_sec;
nb_instructions_per_sec = 0;
wait_ms = 1000;
start = sys_tick_get_time_ms();
do
{
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
asm volatile ("nop ");
nb_instructions_per_sec += 108;
end = sys_tick_get_time_ms();
tickms = sys_tick_delta_time_ms(start, end);
}while(tickms < wait_ms);
return nb_instructions_per_sec;
}
u32 nb_inst_per_sec0;
u32 nb_inst_per_sec1;
int main(void)
{
gpio_setup();
gpio_set(PORT_EN1V8, PIN_EN1V8); /* 1V8 on */
cpu_clock_init();
scs_dwt_cycle_counter_enabled();
systick_setup();
/* Test number of instruction per second */
nb_inst_per_sec0 = test_nb_instruction_per_sec();
nb_inst_per_sec1 = test_nb_instruction_per_sec();
gpio_set(PORT_LED1_3, (PIN_LED1|PIN_LED2|PIN_LED3)); /* LEDs on */
while (1)
{
gpio_set(PORT_LED1_3, (PIN_LED1)); /* LED1 on */
gpio_set(PORT_LED1_3, (PIN_LED2)); /* LED2 on */
gpio_set(PORT_LED1_3, (PIN_LED3)); /* LED3 on */
sys_tick_wait_time_ms(500);
gpio_clear(PORT_LED1_3, (PIN_LED3)); /* LED3 off */
gpio_clear(PORT_LED1_3, (PIN_LED2)); /* LED2 off */
gpio_clear(PORT_LED1_3, (PIN_LED1)); /* LED1 off */
sys_tick_wait_time_ms(500);
}
return 0;
}
Reference in New Issue View Git Blame Copy Permalink