76 lines
1.6 KiB
C
76 lines
1.6 KiB
C
|
|
#include <string.h>
|
|
#include "platform_rmt.h"
|
|
|
|
#include "driver/rmt.h"
|
|
|
|
|
|
static uint8_t rmt_channel_alloc[RMT_CHANNEL_MAX];
|
|
|
|
|
|
static bool rmt_channel_check( uint8_t channel, uint8_t num_mem )
|
|
{
|
|
if (num_mem == 0 || channel >= RMT_CHANNEL_MAX) {
|
|
// wrong parameter
|
|
return false;
|
|
|
|
} else if (num_mem == 1) {
|
|
if (rmt_channel_alloc[channel] == 0)
|
|
return true;
|
|
else
|
|
return false;
|
|
}
|
|
|
|
return rmt_channel_check( channel-1, num_mem-1);
|
|
}
|
|
|
|
int platform_rmt_allocate( uint8_t num_mem, rmt_mode_t mode )
|
|
{
|
|
int channel;
|
|
int alloc_min;
|
|
int alloc_max;
|
|
uint8_t tag = 1;
|
|
|
|
#if SOC_RMT_TX_CANDIDATES_PER_GROUP == SOC_RMT_CHANNELS_PER_GROUP
|
|
alloc_min = 0;
|
|
alloc_max = RMT_CHANNEL_MAX - 1;
|
|
#else
|
|
/* On platforms where channels cannot do both TX and RX, the TX ones always
|
|
seem to start at index 0, and are then followed by the RX channels. */
|
|
if( mode==RMT_MODE_TX ) {
|
|
alloc_min = 0;
|
|
alloc_max = SOC_RMT_TX_CANDIDATES_PER_GROUP - 1;
|
|
} else {
|
|
alloc_min = RMT_CHANNEL_MAX - SOC_RMT_RX_CANDIDATES_PER_GROUP;
|
|
alloc_max = RMT_CHANNEL_MAX - 1;
|
|
}
|
|
#endif
|
|
|
|
for (channel = alloc_max; channel >= alloc_min; channel--) {
|
|
if (rmt_channel_alloc[channel] == 0) {
|
|
if (rmt_channel_check( channel, num_mem )) {
|
|
rmt_channel_alloc[channel] = tag++;
|
|
if (--num_mem == 0)
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (channel >= 0 && num_mem == 0)
|
|
return channel;
|
|
else
|
|
return -1;
|
|
}
|
|
|
|
|
|
void platform_rmt_release( uint8_t channel )
|
|
{
|
|
for ( ; channel < RMT_CHANNEL_MAX; channel++ ) {
|
|
uint8_t tag = rmt_channel_alloc[channel];
|
|
|
|
rmt_channel_alloc[channel] = 0;
|
|
if (tag <= 1)
|
|
break;
|
|
}
|
|
}
|