SYSCALL naked assembly working

[cortex-from-scratch] / main.c

diff --git a/main.c b/main.c
index 35b718e..e87131a 100644 (file)
--- a/main.c
+++ b/main.c
@@ -5,6 +5,8 @@
  * Initial version 
  * 
  * $DESCRIPTION$
+ * Main initialize basic components of the board
+ * and jumps to a terminal
  *
  * */
 
@@ -15,23 +17,122 @@
 #include <sys/robsys.h> 
 #include <sys/mmap.h>
 
+#include <lib/regfunc.h>
+#include <lib/pool.h>
+#include <lib/stdio.h>
+#include <lib/string.h>
+#include <lib/tinyprintf.h>
+
 #include <drivers/uart.h>
+#include <drivers/led.h>
+//#include <drivers/tm1637.h>
+//#include <drivers/at24c.h>
+//#include <drivers/tsensor.h>
+//#include <drivers/mk450_joystick.h>
+#include <drivers/st7735s.h>
+
+
+#include <lib/syscall.h>
+
+int test3(int i, int j) {
+
+       volatile uint32_t * sp = get_msp();
+       
+       /* asm volatile (
+       "tst lr, #4" "\n\t" 
+       "ite eq" "\n\t"
+       "mrseq %0, msp" "\n\t" 
+       "mrsne r0, psp" : "=r" (sp) ); */
+
+       for (int i = 0; (sp + i) < 0x20010000; i++) {
+               printf("ADDRESS: %p, VALUE: %x\n", (sp + i), *(sp + i));
+       }
+
+       for(;;);
+       return 0xCC;
+
+}
+int test2(int i, int j) {
+
+       int x = i * j;
+       test3(0x3A, 0x3B); 
+       
+
+}
+int test(int i, int j) {
+
+       test2(0x2A, 0x2B);
+       
+       return 0xAA;
+}
 
 void main()
 {
+
+       /* Initialize the clock system, */
+       clock_init();
+
+       /* Setup the interrupt vector table */
        ivt_init();
+
+       /* Initialze basic input and output over serial */
        uart_init();
 
+       /* TFT screen */
+       // tft_init();
+       
+       /* Cortex M* integrated systick, can be replaced
+        * by the more accurate RTC.
        systick_init();
+       */
        
+       /* Set up a very small libc library */
+       init_printf(NULL, putc);
+
+       /* Heap init */
+       //kheap_init();
+       //printf("%p\n", get_kheap());
+       
+       /* Display some basic info at startup */
        sysinfo();
 
-       extern void stub();
-       //stub();
-       //__asm__ __volatile__ ("ldc p1, cr1, r0");
+       /* On board LEDs*/
+       led_init();
 
-       terminal();
+       /* Real time clock */
+       //rtc_init();
+
+//     printf("press any key to start\n");
+//     asm volatile ("wfi");
+
+       syscall_init();
+       theos_test(0xA1, 0xA2);
 
+       /* Eeprom Driver
+       eeprom_at24c_init();
+       eeprom_test();
+       */
+       
+       /* LED Segment Driver */
+       //tm1637_init();
+
+       /* ASM Blocking routine */
+       //for (int i = 0; i < 1000; i++)
+       //      _block(10000);
+
+       /* TEMP SENSOR 
+       tsensor_printid();
+       uint16_t temp = tsensor_get_temp();
+       printf("Current temperature: %d °C\n", temp); */
+
+       /* ADC Joystick module */
+       // mk450_init();        
+
+
+       /* Start up terminal */
+       terminal();
+       
+       /* Should not be here, endless loop */
        for(;;) {
 
        }