Diff: source/rtos_none/SysTick_Handler.c

Revision:

0:01f31e923fe2

diff -r 000000000000 -r 01f31e923fe2 source/rtos_none/SysTick_Handler.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/source/rtos_none/SysTick_Handler.c	Tue Apr 07 12:55:42 2020 +0200
@@ -0,0 +1,119 @@
+/**
+ * @file    SysTick_Handler.c
+  * @brief  No RTOS port only needs a systick handler
+ *
+ * DAPLink Interface Firmware
+ * Copyright (c) 2019, ARM Limited, All Rights Reserved
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License"); you may
+ * not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
+ * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include "SysTick_Handler.h"
+#include "device.h"
+
+//SysTick Timer Configuration
+#ifndef OS_CLOCK
+#error "OS_CLOCK should be defined by HIC configuration"
+#endif
+
+//Set the timer tick value for selected timer.
+#ifndef OS_TICK
+#error "OS_TICK should be defined by RTOS configuration"
+#endif
+
+#define OS_TRV          ((uint32_t)(((double)OS_CLOCK*(double)OS_TICK)/1E6)-1)
+
+
+static volatile uint32_t tick_counter = 0;
+static volatile uint32_t event_flags =0;
+static volatile uint32_t wait_counter = 0;
+
+static osTimerFunc_t sysTickCb = NULL;
+static uint32_t tickFreq = 0;
+static osThreadFunc_t mainFuncCb = NULL;
+
+void sysTickInit(void)
+{
+    tick_counter = 0;
+    event_flags=0;
+    wait_counter = 0;
+    sysTickCb = NULL;
+    tickFreq = 0;
+    mainFuncCb = NULL;
+    SysTick_Config(OS_TRV);
+}
+
+
+void SysTick_Handler(void)
+{
+    if (sysTickCb && tickFreq && (tick_counter % tickFreq)==0) {
+        sysTickCb(NULL);
+    }
+    tick_counter++;
+    if(wait_counter){
+        --wait_counter;
+    }
+}
+
+void sysTickRegCallback(osTimerFunc_t callback)
+{
+    sysTickCb = callback;
+}
+
+void sysTickFreqSet(uint32_t ticks)
+{
+    tickFreq = ticks;
+}
+
+void sysTickWait(uint32_t wait)
+{
+    wait_counter = wait;
+    while(wait_counter);
+}
+
+void sysTickEvtSet(uint32_t flag)
+{
+    __disable_irq();
+    event_flags |= flag;
+    __enable_irq();
+}
+
+uint32_t sysTickEvtWaitOr(uint32_t flag)
+{
+    uint32_t return_flags=0;
+    while ((flag&event_flags)==0);
+    return_flags = event_flags;
+    __disable_irq();
+    event_flags &= ~return_flags;
+    __enable_irq();
+    return return_flags;
+}
+
+uint32_t sysTickTime(void)
+{
+    return tick_counter;
+}
+
+void sysTickRegMainFunc(osThreadFunc_t func)
+{
+    mainFuncCb = func;
+}
+
+void sysTickStartMain(void)
+{
+    if(mainFuncCb){
+        mainFuncCb(NULL);
+    }
+}
+