bool ia_css_isys_dma_channel_rmgr_acquire(
isys2401_dma_ID_t dma_id,
isys2401_dma_channel *channel)
{
bool retval = false;
isys2401_dma_channel i;
isys2401_dma_channel max_dma_channel;
isys_dma_rsrc_t *cur_rsrc = NULL;
assert(dma_id < N_ISYS2401_DMA_ID);
assert(channel != NULL);
max_dma_channel = N_ISYS2401_DMA_CHANNEL_PROCS[dma_id];
cur_rsrc = &isys_dma_rsrc[dma_id];
if (cur_rsrc->num_active < max_dma_channel) {
for (i = ISYS2401_DMA_CHANNEL_0; i < N_ISYS2401_DMA_CHANNEL; i++) {
if (bitop_getbit(cur_rsrc->active_table, i) == 0) {
bitop_setbit(cur_rsrc->active_table, i);
*channel = (isys2401_dma_channel)i;
cur_rsrc->num_active++;
retval = true;
break;
}
}
}
return retval;
}
bool ia_css_isys_csi_rx_lut_rmgr_acquire(
csi_rx_backend_ID_t backend,
csi_mipi_packet_type_t packet_type,
csi_rx_backend_lut_entry_t *entry)
{
bool retval = false;
uint16_t max_num_packets_of_type;
uint16_t num_active_of_type;
isys_csi_rx_rsrc_t *cur_rsrc = NULL;
uint16_t i;
assert(backend < N_CSI_RX_BACKEND_ID);
assert((packet_type == CSI_MIPI_PACKET_TYPE_LONG) || (packet_type == CSI_MIPI_PACKET_TYPE_SHORT));
assert(entry != NULL);
if ((backend < N_CSI_RX_BACKEND_ID) && (entry != NULL)) {
cur_rsrc = &isys_csi_rx_rsrc[backend];
if (packet_type == CSI_MIPI_PACKET_TYPE_LONG) {
max_num_packets_of_type = N_LONG_PACKET_LUT_ENTRIES[backend];
num_active_of_type = cur_rsrc->num_long_packets;
} else {
max_num_packets_of_type = N_SHORT_PACKET_LUT_ENTRIES[backend];
num_active_of_type = cur_rsrc->num_short_packets;
}
if (num_active_of_type < max_num_packets_of_type) {
for (i = 0; i < max_num_packets_of_type; i++) {
if (bitop_getbit(cur_rsrc->active_table, i) == 0) {
bitop_setbit(cur_rsrc->active_table, i);
if (packet_type == CSI_MIPI_PACKET_TYPE_LONG) {
entry->long_packet_entry = i;
entry->short_packet_entry = 0;
cur_rsrc->num_long_packets++;
} else {
entry->long_packet_entry = 0;
entry->short_packet_entry = i;
cur_rsrc->num_short_packets++;
}
cur_rsrc->num_active++;
retval = true;
break;
}
}
}
}
return retval;
}
enum ia_css_err ia_css_isys_csi_rx_unregister_stream(
enum ia_css_csi2_port port,
uint32_t sp_thread_id)
{
enum ia_css_err retval = IA_CSS_ERR_INTERNAL_ERROR;
struct sh_css_sp_pipeline_io_status *pipe_io_status;
if ((port < N_INPUT_SYSTEM_CSI_PORT) &&
(sp_thread_id < SH_CSS_MAX_SP_THREADS)) {
pipe_io_status = ia_css_pipeline_get_pipe_io_status();
if (bitop_getbit(pipe_io_status->active[port], sp_thread_id) == 1) {
bitop_clearbit(pipe_io_status->active[port], sp_thread_id);
retval = IA_CSS_SUCCESS;
}
}
return retval;
}
enum ia_css_err ia_css_isys_csi_rx_register_stream(
enum ia_css_csi2_port port,
uint32_t isys_stream_id)
{
enum ia_css_err retval = IA_CSS_ERR_INTERNAL_ERROR;
if ((port < N_INPUT_SYSTEM_CSI_PORT) &&
(isys_stream_id < SH_CSS_MAX_ISYS_CHANNEL_NODES)) {
struct sh_css_sp_pipeline_io_status *pipe_io_status;
pipe_io_status = ia_css_pipeline_get_pipe_io_status();
if (bitop_getbit(pipe_io_status->active[port], isys_stream_id) == 0) {
bitop_setbit(pipe_io_status->active[port], isys_stream_id);
pipe_io_status->running[port] = 0;
retval = IA_CSS_SUCCESS;
}
}
return retval;
}
void ia_css_isys_dma_channel_rmgr_release(
isys2401_dma_ID_t dma_id,
isys2401_dma_channel *channel)
{
isys2401_dma_channel max_dma_channel;
isys_dma_rsrc_t *cur_rsrc = NULL;
assert(dma_id < N_ISYS2401_DMA_ID);
assert(channel != NULL);
max_dma_channel = N_ISYS2401_DMA_CHANNEL_PROCS[dma_id];
cur_rsrc = &isys_dma_rsrc[dma_id];
if ((*channel < max_dma_channel) && (cur_rsrc->num_active > 0)) {
if (bitop_getbit(cur_rsrc->active_table, *channel) == 1) {
bitop_clearbit(cur_rsrc->active_table, *channel);
cur_rsrc->num_active--;
}
}
}
void ia_css_isys_csi_rx_lut_rmgr_release(
csi_rx_backend_ID_t backend,
csi_mipi_packet_type_t packet_type,
csi_rx_backend_lut_entry_t *entry)
{
uint32_t max_num_packets;
isys_csi_rx_rsrc_t *cur_rsrc = NULL;
uint32_t packet_entry = 0;
assert(backend < N_CSI_RX_BACKEND_ID);
assert(entry != NULL);
assert((packet_type >= CSI_MIPI_PACKET_TYPE_LONG) || (packet_type <= CSI_MIPI_PACKET_TYPE_SHORT));
if ((backend < N_CSI_RX_BACKEND_ID) && (entry != NULL)) {
if (packet_type == CSI_MIPI_PACKET_TYPE_LONG) {
max_num_packets = N_LONG_PACKET_LUT_ENTRIES[backend];
packet_entry = entry->long_packet_entry;
} else {
max_num_packets = N_SHORT_PACKET_LUT_ENTRIES[backend];
packet_entry = entry->short_packet_entry;
}
cur_rsrc = &isys_csi_rx_rsrc[backend];
if ((packet_entry < max_num_packets) && (cur_rsrc->num_active > 0)) {
if (bitop_getbit(cur_rsrc->active_table, packet_entry) == 1) {
bitop_clearbit(cur_rsrc->active_table, packet_entry);
if (packet_type == CSI_MIPI_PACKET_TYPE_LONG)
cur_rsrc->num_long_packets--;
else
cur_rsrc->num_short_packets--;
cur_rsrc->num_active--;
}
}
}
}
