aboutsummaryrefslogtreecommitdiffstats
path: root/src/gos/gos_cmsis.c
blob: 2798dcba91f53d436417257c1181c0d90be83b43 (plain)
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
102
103
104
105
106
107
108
109
110
/*
 * This file is subject to the terms of the GFX License. If a copy of
 * the license was not distributed with this file, you can obtain one at:
 *
 *              http://ugfx.org/license.html
 */

#include "../../gfx.h"
#include <string.h>

#if GFX_USE_OS_CMSIS

void _gosHeapInit(void);

void _gosInit(void)
{
	#if !GFX_OS_NO_INIT
		osKernelInitialize();
		if (!osKernelRunning())
			osKernelStart();
	#elif !GFX_OS_INIT_NO_WARNING
		#if GFX_COMPILER_WARNING_TYPE == GFX_COMPILER_WARNING_DIRECT
			#warning "GOS: Operating System initialization has been turned off. Make sure you call osKernelInitialize() and osKernelStart() before gfxInit() in your application!"
		#elif GFX_COMPILER_WARNING_TYPE == GFX_COMPILER_WARNING_MACRO
			COMPILER_WARNING("GOS: Operating System initialization has been turned off. Make sure you call osKernelInitialize() and osKernelStart() before gfxInit() in your application!")
		#endif
	#endif

	// Set up the heap allocator
	_gosHeapInit();
}

void _gosPostInit(void)
{
}

void _gosDeinit(void)
{
}

void gfxMutexInit(gfxMutex* pmutex)
{
	osMutexDef_t def;
	def.mutex = pmutex->mutex;
	
	pmutex->id = osMutexCreate(&def);
}

void gfxSemInit(gfxSem* psem, semcount_t val, semcount_t limit)
{
	osSemaphoreDef_t def;
	def.semaphore = psem->semaphore;
	
	if (val > limit) val = limit;
	psem->available = limit - val;
	psem->id = osSemaphoreCreate(&def, val);
}

void gfxSemDestroy(gfxSem* psem)
{
	osSemaphoreDelete(psem->id);
}

bool_t gfxSemWait(gfxSem* psem, delaytime_t ms)
{
	if (osSemaphoreWait(psem->id, ms) > 0) {
		psem->available++;
		return TRUE;
	}
	return FALSE;
}

bool_t gfxSemWaitI(gfxSem* psem)
{
	return gfxSemWait(psem, 0);
}

void gfxSemSignal(gfxSem* psem)
{
	gfxSemSignalI(psem);
}

void gfxSemSignalI(gfxSem* psem)
{
	if (psem->available) {
		psem->available--;
		osSemaphoreRelease(psem->id);
	}
}

gfxThreadHandle gfxThreadCreate(void* stackarea, size_t stacksz, threadpriority_t prio, DECLARE_THREAD_FUNCTION((*fn),p), void* param)
{	
	osThreadDef_t def;

	(void)stackarea;
	
	def.pthread = (os_pthread)fn;
	def.tpriority = prio;
	def.instances = 1;
	def.stacksize = stacksz;

	return osThreadCreate(&def, param);
}

threadreturn_t gfxThreadWait(gfxThreadHandle thread) {
	while(osThreadGetPriority(thread) == osPriorityError)
		gfxYield();
}

#endif /* GFX_USE_OS_CMSIS */