node-prod-firmware/main.c at master · mxc-foundation/node-prod-firmware · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
#include <stdio.h>
#include <unistd.h>

#include <resmgmt.h>
#include <sys_power_mgr.h>
#include <sys_watchdog.h>

#include "hw/cons.h"
#include "hw/hw.h"
#include "hw/led.h"
#include "lmic/lmic.h"
#include "lora/lora.h"

#define BARRIER()   __asm__ __volatile__ ("":::"memory")

#ifdef CONFIG_RETARGET
extern void	retarget_init(void);
#endif

#if dg_configUSE_WDOG
INITIALISED_PRIVILEGED_DATA int8_t	idle_task_wdog_id = -1;
#endif

PRIVILEGED_DATA static OS_TASK lmic_handle;

void
vApplicationMallocFailedHook(void)
{
	write(1, "malloc\r\n", 8);
	hal_failed();
}

void
vApplicationStackOverflowHook(OS_TASK pxTask, char *pcTaskName)
{
	(void)pxTask;
	(void)pcTaskName;
	write(1, "stack\r\n", 7);
	hal_failed();
}

#if dg_configUSE_WDOG
void
vApplicationIdleHook(void)
{
	sys_watchdog_notify(idle_task_wdog_id);
}
#endif

static void
periph_setup(void)
{
	led_init();
	hal_periph_init();
}

static void
sysinit_task_func(void *param)
{
	(void)param;
	cm_sys_clk_init(sysclk_XTAL16M);
	cm_apb_set_clock_divider(apb_div1);
	cm_ahb_set_clock_divider(ahb_div1);
	cm_lp_clk_init();
#if dg_configUSE_WDOG
	sys_watchdog_init();
	// Register the Idle task first.
	idle_task_wdog_id = sys_watchdog_register(false);
	ASSERT_WARNING(idle_task_wdog_id != -1);
	sys_watchdog_configure_idle_id(idle_task_wdog_id);
#endif
	hal_queue_init();
	cons_init();
	pm_system_init(periph_setup);
	printf("*** " HW_VER_STRING " ***\r\n");
	resource_init();
#ifdef CONFIG_RETARGET
	retarget_init();
#endif
	pm_set_wakeup_mode(true);
	pm_set_sleep_mode(INITIAL_SLEEP_MODE);
	cm_sys_clk_set(sysclk_XTAL16M);
	// Create the main loop function and delete the other.
	OS_TASK_CREATE("LoRa & LMiC", lora_task_func, (void *)0,
	    2048, OS_TASK_PRIORITY_NORMAL, lmic_handle);
	OS_TASK_DELETE(OS_GET_CURRENT_TASK());
}

int
main()
{
	OS_TASK	handle;

	cm_clk_init_low_level();
	OS_TASK_CREATE("sysinit", sysinit_task_func, (void *)0,
	    1024, OS_TASK_PRIORITY_HIGHEST, handle);
	vTaskStartScheduler();
	for (;;)
		;
	return 0;
}