kingkevin
/
espressif_tinyusb
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

more with mynewt

This commit is contained in:
hathach 2019-03-21 00:54:42 +07:00
parent a37bc90ecc
commit 3574688d26
2 changed files with 24 additions and 37 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

41
src/osal/osal_mynewt.h
View File

@ -125,58 +125,45 @@ static inline osal_queue_t osal_queue_create(osal_queue_def_t* qdef)
return (osal_queue_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; struct os_event* ev;
ev = os_eventq_get(&qhdl->evq);
if ( msec == 0 ) memcpy(data, ev->ev_arg, qhdl->item_sz); // copy message
{ os_memblock_put(&qhdl->mpool, ev->ev_arg); // put back mem block
ev = os_eventq_get_no_wait(&queue_hdl->evq); os_memblock_put(&qhdl->epool, ev); // put back ev block
if ( !ev )
{
*p_error = TUSB_ERROR_OSAL_TIMEOUT;
return;
}
}else
{
ev = os_eventq_get(&queue_hdl->evq);
}
memcpy(p_data, ev->ev_arg, queue_hdl->item_sz); // copy message return true;
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;
} }
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; (void) in_isr;
// get a block from mem pool for data // 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; 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 // 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) if (!ev)
{ {
os_memblock_put(&queue_hdl->mpool, ptr); os_memblock_put(&qhdl->mpool, ptr);
return false; return false;
} }
tu_memclr(ev, sizeof(struct os_event)); tu_memclr(ev, sizeof(struct os_event));
ev->ev_arg = ptr; ev->ev_arg = ptr;
os_eventq_put(&queue_hdl->evq, ev); os_eventq_put(&qhdl->evq, ev);
return true; return true;
} }
static inline void osal_queue_flush(osal_queue_t const queue_hdl) static inline void osal_queue_reset(osal_queue_t const queue_hdl)
{ {
// TODO implement later
} }
#ifdef __cplusplus #ifdef __cplusplus

20
src/osal/osal_none.h
View File

@ -164,6 +164,16 @@ static inline osal_queue_t osal_queue_create(osal_queue_def_t* qdef)
return (osal_queue_t) qdef; return (osal_queue_t) qdef;
} }
// non blocking
static inline bool osal_queue_receive(osal_queue_t const qhdl, void* data)
{
_osal_q_lock(qhdl);
bool success = tu_fifo_read(&qhdl->ff, data);
_osal_q_unlock(qhdl);
return success;
}
static inline bool osal_queue_send(osal_queue_t const qhdl, void const * data, bool in_isr) static inline bool osal_queue_send(osal_queue_t const qhdl, void const * data, bool in_isr)
{ {
if (!in_isr) { if (!in_isr) {
@ -186,16 +196,6 @@ static inline void osal_queue_reset(osal_queue_t const qhdl)
// tusb_hal_int_enable_all(); // tusb_hal_int_enable_all();
} }
// non blocking
static inline bool osal_queue_receive(osal_queue_t const qhdl, void* data)
{
_osal_q_lock(qhdl);
bool success = tu_fifo_read(&qhdl->ff, data);
_osal_q_unlock(qhdl);
return success;
}
#ifdef __cplusplus #ifdef __cplusplus
} }
#endif #endif