|
|
@@ -41,6 +41,56 @@ static inline void osal_task_delay(uint32_t msec)
|
|
|
os_time_delay( os_time_ms_to_ticks32(msec) );
|
|
|
}
|
|
|
|
|
|
+//--------------------------------------------------------------------+
|
|
|
+// Semaphore API
|
|
|
+//--------------------------------------------------------------------+
|
|
|
+typedef struct os_sem osal_semaphore_def_t;
|
|
|
+typedef struct os_sem* osal_semaphore_t;
|
|
|
+
|
|
|
+static inline osal_semaphore_t osal_semaphore_create(osal_semaphore_def_t* semdef)
|
|
|
+{
|
|
|
+ return (os_sem_init(semdef, 0) == OS_OK) ? (osal_semaphore_t) semdef : NULL;
|
|
|
+}
|
|
|
+
|
|
|
+static inline bool osal_semaphore_post(osal_semaphore_t sem_hdl, bool in_isr)
|
|
|
+{
|
|
|
+ (void) in_isr;
|
|
|
+ return os_sem_release(sem_hdl) == OS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+static inline bool osal_semaphore_wait(osal_semaphore_t sem_hdl, uint32_t msec)
|
|
|
+{
|
|
|
+ uint32_t const ticks = (msec == OSAL_TIMEOUT_WAIT_FOREVER) ? OS_TIMEOUT_NEVER : os_time_ms_to_ticks32(msec);
|
|
|
+ return os_sem_pend(sem_hdl, ticks) == OS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void osal_semaphore_reset(osal_semaphore_t sem_hdl)
|
|
|
+{
|
|
|
+ // TODO implement later
|
|
|
+}
|
|
|
+
|
|
|
+//--------------------------------------------------------------------+
|
|
|
+// MUTEX API (priority inheritance)
|
|
|
+//--------------------------------------------------------------------+
|
|
|
+typedef struct os_mutex osal_mutex_def_t;
|
|
|
+typedef struct os_mutex* osal_mutex_t;
|
|
|
+
|
|
|
+static inline osal_mutex_t osal_mutex_create(osal_mutex_def_t* mdef)
|
|
|
+{
|
|
|
+ return (os_mutex_init(mdef) == OS_OK) ? (osal_mutex_t) mdef : NULL;
|
|
|
+}
|
|
|
+
|
|
|
+static inline bool osal_mutex_lock(osal_mutex_t mutex_hdl, uint32_t msec)
|
|
|
+{
|
|
|
+ uint32_t const ticks = (msec == OSAL_TIMEOUT_WAIT_FOREVER) ? OS_TIMEOUT_NEVER : os_time_ms_to_ticks32(msec);
|
|
|
+ return os_mutex_pend(mutex_hdl, ticks) == OS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+static inline bool osal_mutex_unlock(osal_mutex_t mutex_hdl)
|
|
|
+{
|
|
|
+ return os_mutex_release(mutex_hdl) == OS_OK;
|
|
|
+}
|
|
|
+
|
|
|
//--------------------------------------------------------------------+
|
|
|
// QUEUE API
|
|
|
//--------------------------------------------------------------------+
|
|
|
@@ -75,109 +125,47 @@ static inline osal_queue_t osal_queue_create(osal_queue_def_t* qdef)
|
|
|
return (osal_queue_t) qdef;
|
|
|
}
|
|
|
|
|
|
-static inline void osal_queue_receive (osal_queue_t const queue_hdl, void *p_data, uint32_t msec, tusb_error_t *p_error)
|
|
|
+static inline bool osal_queue_receive(osal_queue_t const qhdl, void* data)
|
|
|
{
|
|
|
- (void) msec;
|
|
|
struct os_event* ev;
|
|
|
+ ev = os_eventq_get(&qhdl->evq);
|
|
|
|
|
|
- if ( msec == 0 )
|
|
|
- {
|
|
|
- ev = os_eventq_get_no_wait(&queue_hdl->evq);
|
|
|
- if ( !ev )
|
|
|
- {
|
|
|
- *p_error = TUSB_ERROR_OSAL_TIMEOUT;
|
|
|
- return;
|
|
|
- }
|
|
|
- }else
|
|
|
- {
|
|
|
- ev = os_eventq_get(&queue_hdl->evq);
|
|
|
- }
|
|
|
+ memcpy(data, ev->ev_arg, qhdl->item_sz); // copy message
|
|
|
+ os_memblock_put(&qhdl->mpool, ev->ev_arg); // put back mem block
|
|
|
+ os_memblock_put(&qhdl->epool, ev); // put back ev block
|
|
|
|
|
|
- memcpy(p_data, ev->ev_arg, queue_hdl->item_sz); // copy message
|
|
|
- os_memblock_put(&queue_hdl->mpool, ev->ev_arg); // put back mem block
|
|
|
- os_memblock_put(&queue_hdl->epool, ev); // put back ev block
|
|
|
-
|
|
|
- *p_error = TUSB_ERROR_NONE;
|
|
|
+ return true;
|
|
|
}
|
|
|
|
|
|
-static inline bool osal_queue_send(osal_queue_t const queue_hdl, void const * data, bool in_isr)
|
|
|
+static inline bool osal_queue_send(osal_queue_t const qhdl, void const * data, bool in_isr)
|
|
|
{
|
|
|
(void) in_isr;
|
|
|
|
|
|
// get a block from mem pool for data
|
|
|
- void* ptr = os_memblock_get(&queue_hdl->mpool);
|
|
|
+ void* ptr = os_memblock_get(&qhdl->mpool);
|
|
|
if (!ptr) return false;
|
|
|
- memcpy(ptr, data, queue_hdl->item_sz);
|
|
|
+ memcpy(ptr, data, qhdl->item_sz);
|
|
|
|
|
|
// get a block from event pool to put into queue
|
|
|
- struct os_event* ev = (struct os_event*) os_memblock_get(&queue_hdl->epool);
|
|
|
+ struct os_event* ev = (struct os_event*) os_memblock_get(&qhdl->epool);
|
|
|
if (!ev)
|
|
|
{
|
|
|
- os_memblock_put(&queue_hdl->mpool, ptr);
|
|
|
+ os_memblock_put(&qhdl->mpool, ptr);
|
|
|
return false;
|
|
|
}
|
|
|
tu_memclr(ev, sizeof(struct os_event));
|
|
|
ev->ev_arg = ptr;
|
|
|
|
|
|
- os_eventq_put(&queue_hdl->evq, ev);
|
|
|
+ os_eventq_put(&qhdl->evq, ev);
|
|
|
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
-static inline void osal_queue_flush(osal_queue_t const queue_hdl)
|
|
|
-{
|
|
|
-
|
|
|
-}
|
|
|
-
|
|
|
-//--------------------------------------------------------------------+
|
|
|
-// Semaphore API
|
|
|
-//--------------------------------------------------------------------+
|
|
|
-typedef struct os_sem osal_semaphore_def_t;
|
|
|
-typedef struct os_sem* osal_semaphore_t;
|
|
|
-
|
|
|
-static inline osal_semaphore_t osal_semaphore_create(osal_semaphore_def_t* semdef)
|
|
|
-{
|
|
|
- return (os_sem_init(semdef, 0) == OS_OK) ? (osal_semaphore_t) semdef : NULL;
|
|
|
-}
|
|
|
-
|
|
|
-static inline bool osal_semaphore_post(osal_semaphore_t sem_hdl, bool in_isr)
|
|
|
-{
|
|
|
- (void) in_isr;
|
|
|
- return os_sem_release(sem_hdl) == OS_OK;
|
|
|
-}
|
|
|
-
|
|
|
-static inline void osal_semaphore_wait(osal_semaphore_t sem_hdl, uint32_t msec, tusb_error_t *p_error)
|
|
|
-{
|
|
|
- uint32_t const ticks = (msec == OSAL_TIMEOUT_WAIT_FOREVER) ? OS_TIMEOUT_NEVER : os_time_ms_to_ticks32(msec);
|
|
|
- (*p_error) = ( (os_sem_pend(sem_hdl, ticks) == OS_OK) ? TUSB_ERROR_NONE : TUSB_ERROR_OSAL_TIMEOUT );
|
|
|
-}
|
|
|
-
|
|
|
-static inline void osal_semaphore_reset_isr(osal_semaphore_t const sem_hdl)
|
|
|
-{
|
|
|
-// xSemaphoreTakeFromISR(sem_hdl, NULL);
|
|
|
-}
|
|
|
-
|
|
|
-#if 0
|
|
|
-//--------------------------------------------------------------------+
|
|
|
-// MUTEX API (priority inheritance)
|
|
|
-//--------------------------------------------------------------------+
|
|
|
-typedef struct os_mutex osal_mutex_t;
|
|
|
-
|
|
|
-#define osal_mutex_create(x) xSemaphoreCreateMutex()
|
|
|
-
|
|
|
-static inline bool osal_mutex_release(osal_mutex_t mutex_hdl)
|
|
|
+static inline void osal_queue_reset(osal_queue_t const queue_hdl)
|
|
|
{
|
|
|
- return xSemaphoreGive(mutex_hdl);
|
|
|
+ // TODO implement later
|
|
|
}
|
|
|
|
|
|
-static inline void osal_mutex_wait(osal_mutex_t mutex_hdl, uint32_t msec, tusb_error_t *p_error)
|
|
|
-{
|
|
|
- uint32_t const ticks = (msec == OSAL_TIMEOUT_WAIT_FOREVER) ? portMAX_DELAY : pdMS_TO_TICKS(msec);
|
|
|
- (*p_error) = (xSemaphoreTake(mutex_hdl, ticks) ? TUSB_ERROR_NONE : TUSB_ERROR_OSAL_TIMEOUT);
|
|
|
-}
|
|
|
-#endif
|
|
|
-
|
|
|
-
|
|
|
#ifdef __cplusplus
|
|
|
}
|
|
|
#endif
|