--- /dev/null
+/*
+ * Copyright (c) 2013 Qualcomm Atheros, Inc.
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted (subject to the limitations in the
+ * disclaimer below) provided that the following conditions are met:
+ *
+ * * Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ *
+ * * Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the
+ * distribution.
+ *
+ * * Neither the name of Qualcomm Atheros nor the names of its
+ * contributors may be used to endorse or promote products derived
+ * from this software without specific prior written permission.
+ *
+ * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
+ * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT
+ * HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+#include "sys_cfg.h"
+#include "athos_api.h"
+
+#if SYSTEM_MODULE_TIMER
+
+//#define TIMER_NOT_IN_USE ((cmnos_timer_t *)-1)
+#define TIMER_NOT_IN_USE NULL
+
+/* convert milliseconds to ticks */
+#define MILLIS_TO_TIMER_TICKS(ms) (ms*ONE_MSEC)
+
+/* Current tick time */
+//#define NOW() xthal_get_ccount()
+
+#define TIMER_IS_EARLIER(t1, t2) ((A_INT32)((A_UINT32)t1-(A_UINT32)t2)<=0)
+
+
+typedef struct cmnos_timer_s {
+ struct cmnos_timer_s *timer_next;
+ A_UINT32 timer_expire;
+ A_UINT32 timer_period;
+ A_TIMER_FUNC *timer_function;
+ void *timer_arg;
+} cmnos_timer_t; /* A_timer_t */
+
+LOCAL cmnos_timer_t *timer_list = NULL;
+
+
+/* Initialize a timer. Initially, it is unarmed. */
+LOCAL void
+cmnos_timer_setfn(A_timer_t *A_timer, A_TIMER_FUNC *pfunction, void *parg)
+{
+ cmnos_timer_t *ptimer = (cmnos_timer_t *)A_timer;
+
+ ptimer->timer_next = TIMER_NOT_IN_USE;
+ ptimer->timer_expire = 0; /* sanity */
+ ptimer->timer_function = pfunction;
+ ptimer->timer_arg = parg;
+}
+
+/* Arm a timer to trigger after the specified time */
+LOCAL void
+cmnos_timer_arm(A_timer_t *A_timer,
+ unsigned int milliseconds)
+{
+ cmnos_timer_t *ptimer = (cmnos_timer_t *)A_timer;
+ A_UINT32 timer_expire;
+ A_UINT32 timer_ticks;
+ cmnos_timer_t *curr, *prev = NULL;
+
+ /* Convert milliseconds to ticks */
+ timer_ticks = MILLIS_TO_TIMER_TICKS(milliseconds);
+
+ /* Calculate expiring tick time */
+ timer_expire = NOW() + timer_ticks;
+
+ /* Find the right place to insert */
+ for (curr = timer_list;
+ curr;
+ prev=curr, curr = curr->timer_next)
+ {
+ if (TIMER_IS_EARLIER(timer_expire, curr->timer_expire))
+ break;
+ }
+
+ /* Inster timer to the list */
+ ptimer->timer_next = curr;
+ ptimer->timer_expire = timer_expire;
+ if (prev) {
+ prev->timer_next = ptimer;
+ } else {
+ /* Insert at head of the timer list */
+ timer_list = ptimer;
+ }
+
+ return;
+}
+
+/* Disarm a timer, if it is currently armed. */
+LOCAL void
+cmnos_timer_disarm(A_timer_t *A_timer)
+{
+ cmnos_timer_t *ptimer = (cmnos_timer_t *)A_timer;
+ cmnos_timer_t *curr, *prev = NULL;
+
+ /* Find desired timer */
+ for (curr = timer_list;
+ curr;
+ prev=curr, curr = curr->timer_next)
+ {
+ if (ptimer == curr) {
+ break;
+ }
+ }
+
+ /* Remove it from the timer list */
+ if (curr) {
+ if (prev) {
+ prev->timer_next = curr->timer_next;
+ } else {
+ timer_list = curr->timer_next;
+ }
+ }
+
+ /* Clear timer parameters */
+ ptimer->timer_next = TIMER_NOT_IN_USE;
+ ptimer->timer_period = 0;
+}
+
+/* Initialize timer software. Called once during initialization. */
+LOCAL void
+cmnos_timer_init(void)
+{
+ timer_list = NULL;
+}
+
+/* Handler for LF0 Timer. */
+LOCAL void
+cmnos_timer_handler(void)
+{
+ cmnos_timer_t *ptimer;
+
+ while (timer_list &&
+ TIMER_IS_EARLIER(timer_list->timer_expire, NOW()))
+ {
+ ptimer = timer_list;
+ timer_list = timer_list->timer_next;
+ ptimer->timer_next = TIMER_NOT_IN_USE;
+ ptimer->timer_function((A_HANDLE)ptimer, ptimer->timer_arg);
+ }
+ return;
+}
+
+void
+cmnos_timer_module_install(struct timer_api *tbl)
+{
+ tbl->_timer_init = cmnos_timer_init;
+ tbl->_timer_arm = cmnos_timer_arm;
+ tbl->_timer_disarm = cmnos_timer_disarm;
+ tbl->_timer_setfn = cmnos_timer_setfn;
+ tbl->_timer_run = cmnos_timer_handler;
+}
+
+//#define CMNOS_TIMER_UT
+#ifdef CMNOS_TIMER_UT
+
+#include <adf_os_timer.h>
+
+adf_os_timer_t timer1;
+adf_os_timer_t timer2;
+
+void test_timer(void *arg)
+{
+ adf_os_timer_t *tmp = (adf_os_timer_t *) arg;
+
+ if ( tmp == &timer1 ) {
+ adf_os_print("Timer1 is fired\n");
+ adf_os_timer_start(&timer1, 1000);
+ } else {
+ adf_os_print("Timer2 is fired\n");
+ adf_os_timer_start(&timer2, 3000);
+ }
+}
+
+void
+cmnos_timer_test()
+{
+ adf_os_timer_init(NULL, &timer1, test_timer, &timer1);
+ adf_os_timer_init(NULL, &timer2, test_timer, &timer2);
+ adf_os_timer_start(&timer1, 1000);
+ adf_os_timer_start(&timer2, 3000);
+}
+
+#endif
+
+#endif /* end SYSTEM_MODULE_TIMER */
+