use for loop instead of__builtin_ctz() which is not portable (e.g with ccrx)

This commit is contained in:
hathach 2024-04-10 18:26:56 +07:00
parent f1944f2b37
commit fb69d80e70
No known key found for this signature in database
GPG Key ID: 26FAB84F615C3C52

View File

@ -89,39 +89,39 @@ static dcd_data_t _dcd;
// INTERNAL OBJECT & FUNCTION DECLARATION // INTERNAL OBJECT & FUNCTION DECLARATION
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// Transfer conditions specifiable for each pipe: // Transfer conditions specifiable for each pipe for most MCUs
// - Pipe 0: Control transfer with 64-byte single buffer // - Pipe 0: Control transfer with 64-byte single buffer
// - Pipes 1 and 2: Bulk isochronous transfer continuous transfer mode with programmable buffer size up // - Pipes 1 and 2: Bulk or ISO
// to 2 KB and optional double buffer // - Pipes 3 to 5: Bulk
// - Pipes 3 to 5: Bulk transfer continuous transfer mode with programmable buffer size up to 2 KB and // - Pipes 6 to 9: Interrupt
// optional double buffer //
// - Pipes 6 to 9: Interrupt transfer with 64-byte single buffer // Note: for small mcu such as
// - RA2A1: only pipe 4-7 are available, and no support for ISO
enum { enum {
PIPE_1ST_BULK = 3, PIPE_LAST_ISO = 2,
PIPE_1ST_INTERRUPT = 6, PIPE_LAST_BULK = 5,
PIPE_LAST_INTERRUPT = 9,
PIPE_COUNT = 10, PIPE_COUNT = 10,
}; };
static unsigned find_pipe(unsigned xfer) static unsigned find_pipe(unsigned xfer_type) {
{ switch (xfer_type) {
switch (xfer) {
case TUSB_XFER_ISOCHRONOUS: case TUSB_XFER_ISOCHRONOUS:
for (int i = 1; i < PIPE_1ST_BULK; ++i) { for (int i = PIPE_LAST_ISO; i > 0; i--) {
if (0 == _dcd.pipe[i].ep) return i; if (0 == _dcd.pipe[i].ep) return i;
} }
break; break;
case TUSB_XFER_BULK: case TUSB_XFER_BULK:
for (int i = PIPE_1ST_BULK; i < PIPE_1ST_INTERRUPT; ++i) { // find backward since only pipe 1, 2 support ISO
if (0 == _dcd.pipe[i].ep) return i; for (int i = PIPE_LAST_BULK; i > 0; i--) {
}
for (int i = 1; i < PIPE_1ST_BULK; ++i) {
if (0 == _dcd.pipe[i].ep) return i; if (0 == _dcd.pipe[i].ep) return i;
} }
break; break;
case TUSB_XFER_INTERRUPT: case TUSB_XFER_INTERRUPT:
for (int i = PIPE_1ST_INTERRUPT; i < PIPE_COUNT; ++i) { for(int i = PIPE_LAST_INTERRUPT; i > PIPE_LAST_BULK; i--) {
if (0 == _dcd.pipe[i].ep) return i; if (0 == _dcd.pipe[i].ep) return i;
} }
break; break;
@ -1025,20 +1025,12 @@ void dcd_int_handler(uint8_t rhport)
unsigned s = rusb->BRDYSTS & m; unsigned s = rusb->BRDYSTS & m;
/* clear active bits (don't write 0 to already cleared bits according to the HW manual) */ /* clear active bits (don't write 0 to already cleared bits according to the HW manual) */
rusb->BRDYSTS = ~s; rusb->BRDYSTS = ~s;
while (s) {
#if defined(__CCRX__)
static const int Mod37BitPosition[] = {
-1, 0, 1, 26, 2, 23, 27, 0, 3, 16, 24, 30, 28, 11, 0, 13, 4,
7, 17, 0, 25, 22, 31, 15, 29, 10, 12, 6, 0, 21, 14, 9, 5,
20, 8, 19, 18
};
const unsigned num = Mod37BitPosition[(-s & s) % 37]; for (unsigned pipe = 0; pipe < PIPE_COUNT; ++pipe) {
#else if (tu_bit_test(s, pipe)) {
const unsigned num = __builtin_ctz(s); process_pipe_brdy(rhport, pipe);
#endif s = tu_bit_clear(s, pipe);
process_pipe_brdy(rhport, num); }
s &= ~TU_BIT(num);
} }
} }
} }