| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Support for Intel Camera Imaging ISP subsystem. |
| * Copyright (c) 2010-2015, Intel Corporation. |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms and conditions of the GNU General Public License, |
| * version 2, as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope it will be useful, but WITHOUT |
| * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| * more details. |
| */ |
| |
| #include "fifo_monitor.h" |
| |
| #include <type_support.h> |
| #include "device_access.h" |
| |
| #include <bits.h> |
| |
| #include "gp_device.h" |
| |
| #include "assert_support.h" |
| |
| #ifndef __INLINE_FIFO_MONITOR__ |
| #define STORAGE_CLASS_FIFO_MONITOR_DATA static const |
| #else |
| #define STORAGE_CLASS_FIFO_MONITOR_DATA const |
| #endif /* __INLINE_FIFO_MONITOR__ */ |
| |
| STORAGE_CLASS_FIFO_MONITOR_DATA unsigned int FIFO_SWITCH_ADDR[N_FIFO_SWITCH] = { |
| _REG_GP_SWITCH_IF_ADDR, |
| _REG_GP_SWITCH_GDC1_ADDR, |
| _REG_GP_SWITCH_GDC2_ADDR |
| }; |
| |
| #ifndef __INLINE_FIFO_MONITOR__ |
| #include "fifo_monitor_private.h" |
| #endif /* __INLINE_FIFO_MONITOR__ */ |
| |
| static inline bool fifo_monitor_status_valid( |
| const fifo_monitor_ID_t ID, |
| const unsigned int reg, |
| const unsigned int port_id); |
| |
| static inline bool fifo_monitor_status_accept( |
| const fifo_monitor_ID_t ID, |
| const unsigned int reg, |
| const unsigned int port_id); |
| |
| void fifo_channel_get_state( |
| const fifo_monitor_ID_t ID, |
| const fifo_channel_t channel_id, |
| fifo_channel_state_t *state) |
| { |
| assert(channel_id < N_FIFO_CHANNEL); |
| assert(state); |
| |
| switch (channel_id) { |
| case FIFO_CHANNEL_ISP0_TO_SP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_SP); /* ISP_STR_MON_PORT_ISP2SP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_SP); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_ISP); /* ISP_STR_MON_PORT_SP2ISP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_ISP); |
| break; |
| case FIFO_CHANNEL_SP0_TO_ISP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_ISP); /* ISP_STR_MON_PORT_SP2ISP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_ISP); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_SP); /* ISP_STR_MON_PORT_ISP2SP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_SP); |
| break; |
| case FIFO_CHANNEL_ISP0_TO_IF0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_PIF_A); /* ISP_STR_MON_PORT_ISP2PIFA */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_PIF_A); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_A); /* MOD_STR_MON_PORT_CELLS2PIFA */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_A); |
| break; |
| case FIFO_CHANNEL_IF0_TO_ISP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_A); /* MOD_STR_MON_PORT_PIFA2CELLS */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_A); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_PIF_A); /* ISP_STR_MON_PORT_PIFA2ISP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_PIF_A); |
| break; |
| case FIFO_CHANNEL_ISP0_TO_IF1: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_PIF_B); /* ISP_STR_MON_PORT_ISP2PIFA */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_PIF_B); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_B); /* MOD_STR_MON_PORT_CELLS2PIFB */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_B); |
| break; |
| case FIFO_CHANNEL_IF1_TO_ISP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_B); /* MOD_STR_MON_PORT_PIFB2CELLS */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_B); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_PIF_B); /* ISP_STR_MON_PORT_PIFB2ISP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_PIF_B); |
| break; |
| case FIFO_CHANNEL_ISP0_TO_DMA0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_DMA); /* ISP_STR_MON_PORT_ISP2DMA */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_DMA); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_DMA_FR_ISP); /* MOD_STR_MON_PORT_ISP2DMA */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_DMA_FR_ISP); |
| break; |
| case FIFO_CHANNEL_DMA0_TO_ISP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_DMA2ISP); /* MOD_STR_MON_PORT_DMA2ISP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_DMA2ISP); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_DMA); /* ISP_STR_MON_PORT_DMA2ISP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_DMA); |
| break; |
| case FIFO_CHANNEL_ISP0_TO_GDC0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_GDC); /* ISP_STR_MON_PORT_ISP2GDC1 */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_GDC); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_GDC); /* MOD_STR_MON_PORT_CELLS2GDC1 */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_GDC); |
| break; |
| case FIFO_CHANNEL_GDC0_TO_ISP0: |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_GDC); /* MOD_STR_MON_PORT_GDC12CELLS */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_GDC); |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_GDC); /* ISP_STR_MON_PORT_GDC12ISP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_GDC); |
| break; |
| case FIFO_CHANNEL_ISP0_TO_GDC1: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_ISP2GDC2); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_ISP2GDC2); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_CELLS2GDC2); |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_CELLS2GDC2); |
| break; |
| case FIFO_CHANNEL_GDC1_TO_ISP0: |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_GDC22CELLS); |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_GDC22CELLS); |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_GDC22ISP); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_GDC22ISP); |
| break; |
| case FIFO_CHANNEL_ISP0_TO_HOST0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_GPD); /* ISP_STR_MON_PORT_ISP2GPD */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_SND_GPD); |
| { |
| hrt_data value = ia_css_device_load_uint32(0x0000000000380014ULL); |
| |
| state->fifo_valid = !_hrt_get_bit(value, 0); |
| state->sink_accept = false; /* no monitor connected */ |
| } |
| break; |
| case FIFO_CHANNEL_HOST0_TO_ISP0: { |
| hrt_data value = ia_css_device_load_uint32(0x000000000038001CULL); |
| |
| state->fifo_valid = false; /* no monitor connected */ |
| state->sink_accept = !_hrt_get_bit(value, 0); |
| } |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_GPD); /* ISP_STR_MON_PORT_FA2ISP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_ISP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_GPD); |
| break; |
| case FIFO_CHANNEL_SP0_TO_IF0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_PIF_A); /* SP_STR_MON_PORT_SP2PIFA */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_PIF_A); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_A); /* MOD_STR_MON_PORT_CELLS2PIFA */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_A); |
| break; |
| case FIFO_CHANNEL_IF0_TO_SP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_A); /* MOD_STR_MON_PORT_PIFA2CELLS */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_A); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_PIF_A); /* SP_STR_MON_PORT_PIFA2SP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_PIF_A); |
| break; |
| case FIFO_CHANNEL_SP0_TO_IF1: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_PIF_B); /* SP_STR_MON_PORT_SP2PIFB */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_PIF_B); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_B); /* MOD_STR_MON_PORT_CELLS2PIFB */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_PIF_B); |
| break; |
| case FIFO_CHANNEL_IF1_TO_SP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_B); /* MOD_STR_MON_PORT_PIFB2CELLS */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_PIF_B); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_PIF_B); /* SP_STR_MON_PORT_PIFB2SP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| ISP_STR_MON_PORT_RCV_PIF_B); |
| break; |
| case FIFO_CHANNEL_SP0_TO_IF2: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_SIF); /* SP_STR_MON_PORT_SP2SIF */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_SIF); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_SIF); /* MOD_STR_MON_PORT_SP2SIF */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_SIF); |
| break; |
| case FIFO_CHANNEL_IF2_TO_SP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_SIF); /* MOD_STR_MON_PORT_SIF2SP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_SIF); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_SIF); /* SP_STR_MON_PORT_SIF2SP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_SIF); |
| break; |
| case FIFO_CHANNEL_SP0_TO_DMA0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_DMA); /* SP_STR_MON_PORT_SP2DMA */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_DMA); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_DMA_FR_SP); /* MOD_STR_MON_PORT_SP2DMA */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_DMA_FR_SP); |
| break; |
| case FIFO_CHANNEL_DMA0_TO_SP0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_DMA2SP); /* MOD_STR_MON_PORT_DMA2SP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_DMA2SP); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_DMA); /* SP_STR_MON_PORT_DMA2SP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_DMA); |
| break; |
| case FIFO_CHANNEL_SP0_TO_GDC0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_SP2GDC1); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_SP2GDC1); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_CELLS2GDC1); |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_CELLS2GDC1); |
| break; |
| case FIFO_CHANNEL_GDC0_TO_SP0: |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_GDC12CELLS); |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_GDC12CELLS); |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_GDC12SP); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_GDC12SP); |
| break; |
| case FIFO_CHANNEL_SP0_TO_GDC1: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_SP2GDC2); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_SP2GDC2); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_CELLS2GDC2); |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_CELLS2GDC2); |
| break; |
| case FIFO_CHANNEL_GDC1_TO_SP0: |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_GDC22CELLS); |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_GDC22CELLS); |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_GDC22SP); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_B_IDX, |
| SP_STR_MON_PORT_B_GDC22SP); |
| break; |
| case FIFO_CHANNEL_SP0_TO_HOST0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_GPD); /* SP_STR_MON_PORT_SP2GPD */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_GPD); |
| { |
| hrt_data value = ia_css_device_load_uint32(0x0000000000380010ULL); |
| |
| state->fifo_valid = !_hrt_get_bit(value, 0); |
| state->sink_accept = false; /* no monitor connected */ |
| } |
| break; |
| case FIFO_CHANNEL_HOST0_TO_SP0: { |
| hrt_data value = ia_css_device_load_uint32(0x0000000000380018ULL); |
| |
| state->fifo_valid = false; /* no monitor connected */ |
| state->sink_accept = !_hrt_get_bit(value, 0); |
| } |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_GPD); /* SP_STR_MON_PORT_FA2SP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_GPD); |
| break; |
| case FIFO_CHANNEL_SP0_TO_STREAM2MEM0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_MC); /* SP_STR_MON_PORT_SP2MC */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SND_MC); |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_MC); /* MOD_STR_MON_PORT_SP2MC */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_RCV_MC); |
| break; |
| case FIFO_CHANNEL_STREAM2MEM0_TO_SP0: |
| state->fifo_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_MC); /* SP_STR_MON_PORT_MC2SP */ |
| state->sink_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_MOD_STREAM_STAT_IDX, |
| MOD_STR_MON_PORT_SND_MC); |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_MC); /* MOD_STR_MON_PORT_MC2SP */ |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_RCV_MC); |
| break; |
| case FIFO_CHANNEL_SP0_TO_INPUT_SYSTEM0: |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SP2ISYS); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_SP2ISYS); |
| state->fifo_valid = false; |
| state->sink_accept = false; |
| break; |
| case FIFO_CHANNEL_INPUT_SYSTEM0_TO_SP0: |
| state->fifo_valid = false; |
| state->sink_accept = false; |
| state->src_valid = fifo_monitor_status_valid(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_ISYS2SP); |
| state->fifo_accept = fifo_monitor_status_accept(ID, |
| HIVE_GP_REGS_SP_STREAM_STAT_IDX, |
| SP_STR_MON_PORT_ISYS2SP); |
| break; |
| default: |
| assert(0); |
| break; |
| } |
| |
| return; |
| } |
| |
| void fifo_switch_get_state( |
| const fifo_monitor_ID_t ID, |
| const fifo_switch_t switch_id, |
| fifo_switch_state_t *state) |
| { |
| hrt_data data = (hrt_data)-1; |
| |
| assert(ID == FIFO_MONITOR0_ID); |
| assert(switch_id < N_FIFO_SWITCH); |
| assert(state); |
| |
| (void)ID; |
| |
| data = gp_device_reg_load(GP_DEVICE0_ID, FIFO_SWITCH_ADDR[switch_id]); |
| |
| state->is_none = (data == HIVE_ISP_CSS_STREAM_SWITCH_NONE); |
| state->is_sp = (data == HIVE_ISP_CSS_STREAM_SWITCH_SP); |
| state->is_isp = (data == HIVE_ISP_CSS_STREAM_SWITCH_ISP); |
| |
| return; |
| } |
| |
| void fifo_monitor_get_state( |
| const fifo_monitor_ID_t ID, |
| fifo_monitor_state_t *state) |
| { |
| fifo_channel_t ch_id; |
| fifo_switch_t sw_id; |
| |
| assert(ID < N_FIFO_MONITOR_ID); |
| assert(state); |
| |
| for (ch_id = 0; ch_id < N_FIFO_CHANNEL; ch_id++) { |
| fifo_channel_get_state(ID, ch_id, |
| &state->fifo_channels[ch_id]); |
| } |
| |
| for (sw_id = 0; sw_id < N_FIFO_SWITCH; sw_id++) { |
| fifo_switch_get_state(ID, sw_id, |
| &state->fifo_switches[sw_id]); |
| } |
| return; |
| } |
| |
| static inline bool fifo_monitor_status_valid( |
| const fifo_monitor_ID_t ID, |
| const unsigned int reg, |
| const unsigned int port_id) |
| { |
| hrt_data data = fifo_monitor_reg_load(ID, reg); |
| |
| return (data >> (((port_id * 2) + _hive_str_mon_valid_offset))) & 0x1; |
| } |
| |
| static inline bool fifo_monitor_status_accept( |
| const fifo_monitor_ID_t ID, |
| const unsigned int reg, |
| const unsigned int port_id) |
| { |
| hrt_data data = fifo_monitor_reg_load(ID, reg); |
| |
| return (data >> (((port_id * 2) + _hive_str_mon_accept_offset))) & 0x1; |
| } |
