mirror of https://gerrit.osmocom.org/simtrace2
usb_buf: count number of elements in queue
This is in preparation for limiting the maximum queue length Change-Id: I7cb184d7a1ccb519010a2f3e3295cc3a5fbf8052 Related: OS#4251
This commit is contained in:
parent
271be9d181
commit
f4a625be53
|
@ -29,6 +29,8 @@ struct usb_buffered_ep {
|
|||
volatile uint32_t in_progress;
|
||||
/* Tx queue (IN) / Rx queue (OUT) */
|
||||
struct llist_head queue;
|
||||
/* current length of queue */
|
||||
unsigned int queue_len;
|
||||
};
|
||||
|
||||
struct msgb *usb_buf_alloc(uint8_t ep);
|
||||
|
|
|
@ -260,18 +260,18 @@ struct msgb *usb_buf_alloc_st(uint8_t ep, uint8_t msg_class, uint8_t msg_type)
|
|||
while (!msg) {
|
||||
msg = usb_buf_alloc(ep); // try to allocate some memory
|
||||
if (!msg) { // allocation failed, we might be out of memory
|
||||
struct llist_head *queue = usb_get_queue(ep);
|
||||
if (!queue) {
|
||||
struct usb_buffered_ep *bep = usb_get_buf_ep(ep);
|
||||
if (!bep) {
|
||||
TRACE_ERROR("ep %u: %s queue does not exist\n\r",
|
||||
ep, __func__);
|
||||
return NULL;
|
||||
}
|
||||
if (llist_empty(queue)) {
|
||||
if (llist_empty(&bep->queue)) {
|
||||
TRACE_ERROR("ep %u: %s EOMEM (queue already empty)\n\r",
|
||||
ep, __func__);
|
||||
return NULL;
|
||||
}
|
||||
msg = msgb_dequeue(queue);
|
||||
msg = msgb_dequeue_count(&bep->queue, &bep->queue_len);
|
||||
if (!msg) {
|
||||
TRACE_ERROR("ep %u: %s no msg in non-empty queue\n\r",
|
||||
ep, __func__);
|
||||
|
|
|
@ -76,7 +76,7 @@ int usb_refill_to_host(uint8_t ep)
|
|||
|
||||
bep->in_progress++;
|
||||
|
||||
msg = msgb_dequeue(&bep->queue);
|
||||
msg = msgb_dequeue_count(&bep->queue, &bep->queue_len);
|
||||
|
||||
local_irq_restore(x);
|
||||
|
||||
|
@ -180,7 +180,7 @@ int usb_drain_queue(uint8_t ep)
|
|||
}
|
||||
|
||||
/* free all queued msgbs */
|
||||
while ((msg = msgb_dequeue(&bep->queue))) {
|
||||
while ((msg = msgb_dequeue_count(&bep->queue, &bep->queue_len))) {
|
||||
usb_buf_free(msg);
|
||||
ret++;
|
||||
}
|
||||
|
|
|
@ -78,7 +78,7 @@ int usb_buf_submit(struct msgb *msg)
|
|||
|
||||
/* no need for irqsafe operation, as the usb_tx_queue is
|
||||
* processed only by the main loop context */
|
||||
msgb_enqueue(&ep->queue, msg);
|
||||
msgb_enqueue_count(&ep->queue, msg, &ep->queue_len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
|
@ -80,6 +80,49 @@ extern int msgb_resize_area(struct msgb *msg, uint8_t *area,
|
|||
extern struct msgb *msgb_copy(const struct msgb *msg, const char *name);
|
||||
static int msgb_test_invariant(const struct msgb *msg) __attribute__((pure));
|
||||
|
||||
/*! Free all msgbs from a queue built with msgb_enqueue().
|
||||
* \param[in] queue list head of a msgb queue.
|
||||
*/
|
||||
static inline void msgb_queue_free(struct llist_head *queue)
|
||||
{
|
||||
struct msgb *msg;
|
||||
while ((msg = msgb_dequeue(queue))) msgb_free(msg);
|
||||
}
|
||||
|
||||
/*! Enqueue message buffer to tail of a queue and increment queue size counter
|
||||
* \param[in] queue linked list header of queue
|
||||
* \param[in] msg message buffer to be added to the queue
|
||||
* \param[in] count pointer to variable holding size of the queue
|
||||
*
|
||||
* The function will append the specified message buffer \a msg to the queue
|
||||
* implemented by \ref llist_head \a queue using function \ref msgb_enqueue_count,
|
||||
* then increment \a count
|
||||
*/
|
||||
static inline void msgb_enqueue_count(struct llist_head *queue, struct msgb *msg,
|
||||
unsigned int *count)
|
||||
{
|
||||
msgb_enqueue(queue, msg);
|
||||
(*count)++;
|
||||
}
|
||||
|
||||
/*! Dequeue message buffer from head of queue and decrement queue size counter
|
||||
* \param[in] queue linked list header of queue
|
||||
* \param[in] count pointer to variable holding size of the queue
|
||||
* \returns message buffer (if any) or NULL if queue empty
|
||||
*
|
||||
* The function will remove the first message buffer from the queue
|
||||
* implemented by \ref llist_head \a queue using function \ref msgb_enqueue_count,
|
||||
* and decrement \a count, all if queue is not empty.
|
||||
*/
|
||||
static inline struct msgb *msgb_dequeue_count(struct llist_head *queue,
|
||||
unsigned int *count)
|
||||
{
|
||||
struct msgb *msg = msgb_dequeue(queue);
|
||||
if (msg)
|
||||
(*count)--;
|
||||
return msg;
|
||||
}
|
||||
|
||||
#ifdef MSGB_DEBUG
|
||||
#include <osmocom/core/panic.h>
|
||||
#define MSGB_ABORT(msg, fmt, args ...) do { \
|
||||
|
|
|
@ -177,14 +177,14 @@ static void dump_rctx(struct msgb *msg)
|
|||
|
||||
static void get_and_verify_rctx(uint8_t ep, const uint8_t *data, unsigned int len)
|
||||
{
|
||||
struct llist_head *queue = usb_get_queue(ep);
|
||||
struct usb_buffered_ep *bep = usb_get_buf_ep(ep);
|
||||
struct msgb *msg;
|
||||
struct cardemu_usb_msg_tx_data *td;
|
||||
struct cardemu_usb_msg_rx_data *rd;
|
||||
struct simtrace_msg_hdr *mh;
|
||||
|
||||
assert(queue);
|
||||
msg = msgb_dequeue(queue);
|
||||
assert(bep);
|
||||
msg = msgb_dequeue_count(&bep->queue, &bep->queue_len);
|
||||
assert(msg);
|
||||
dump_rctx(msg);
|
||||
assert(msg->l1h);
|
||||
|
@ -214,13 +214,13 @@ static void get_and_verify_rctx(uint8_t ep, const uint8_t *data, unsigned int le
|
|||
|
||||
static void get_and_verify_rctx_pps(const uint8_t *data, unsigned int len)
|
||||
{
|
||||
struct llist_head *queue = usb_get_queue(PHONE_DATAIN);
|
||||
struct usb_buffered_ep *bep = usb_get_buf_ep(PHONE_DATAIN);
|
||||
struct msgb *msg;
|
||||
struct simtrace_msg_hdr *mh;
|
||||
struct cardemu_usb_msg_pts_info *ptsi;
|
||||
|
||||
assert(queue);
|
||||
msg = msgb_dequeue(queue);
|
||||
assert(bep);
|
||||
msg = msgb_dequeue_count(&bep->queue, &bep->queue_len);
|
||||
assert(msg);
|
||||
dump_rctx(msg);
|
||||
assert(msg->l1h);
|
||||
|
|
Loading…
Reference in New Issue