git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@4269 35acf78f-673a-0410-8e92-d51de3d6d3f4
parent
aed1b78c87
commit
f32e8bf381
|
@ -315,18 +315,21 @@ static void otg_fifo_read_to_queue(InputQueue *iqp, size_t n) {
|
||||||
*iqp->q_wrptr++ = (uint8_t)(dw >> 8);
|
*iqp->q_wrptr++ = (uint8_t)(dw >> 8);
|
||||||
if (iqp->q_wrptr >= iqp->q_top)
|
if (iqp->q_wrptr >= iqp->q_top)
|
||||||
iqp->q_wrptr = iqp->q_buffer;
|
iqp->q_wrptr = iqp->q_buffer;
|
||||||
|
|
||||||
|
if (--nb > 0) {
|
||||||
|
*iqp->q_wrptr++ = (uint8_t)(dw >> 16);
|
||||||
|
if (iqp->q_wrptr >= iqp->q_top)
|
||||||
|
iqp->q_wrptr = iqp->q_buffer;
|
||||||
|
|
||||||
|
if (--nb > 0) {
|
||||||
|
*iqp->q_wrptr++ = (uint8_t)(dw >> 24);
|
||||||
|
if (iqp->q_wrptr >= iqp->q_top)
|
||||||
|
iqp->q_wrptr = iqp->q_buffer;
|
||||||
|
|
||||||
|
--nb;
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
else if (--nb > 0) {
|
|
||||||
*iqp->q_wrptr++ = (uint8_t)(dw >> 16);
|
|
||||||
if (iqp->q_wrptr >= iqp->q_top)
|
|
||||||
iqp->q_wrptr = iqp->q_buffer;
|
|
||||||
}
|
|
||||||
else if (--nb > 0) {
|
|
||||||
*iqp->q_wrptr++ = (uint8_t)(dw >> 24);
|
|
||||||
if (iqp->q_wrptr >= iqp->q_top)
|
|
||||||
iqp->q_wrptr = iqp->q_buffer;
|
|
||||||
}
|
|
||||||
--nb;
|
|
||||||
} while (--nw > 0);
|
} while (--nw > 0);
|
||||||
|
|
||||||
/* Updating queue.*/
|
/* Updating queue.*/
|
||||||
|
|
Loading…
Reference in New Issue