void sp_get_state(
const sp_ID_t ID,
sp_state_t *state,
sp_stall_t *stall)
{
hrt_data sc = sp_ctrl_load(ID, SP_SC_REG);
assert(state != NULL);
assert(stall != NULL);
state->pc = sp_ctrl_load(ID, SP_PC_REG);
state->status_register = sc;
state->is_broken = (sc & (1U << SP_BROKEN_BIT)) != 0;
state->is_idle = (sc & (1U << SP_IDLE_BIT)) != 0;
state->is_sleeping = (sc & (1U << SP_SLEEPING_BIT)) != 0;
state->is_stalling = (sc & (1U << SP_STALLING_BIT)) != 0;
stall->fifo0 =
!sp_ctrl_getbit(ID, SP_FIFO0_SINK_REG, SP_FIFO0_SINK_BIT);
stall->fifo1 =
!sp_ctrl_getbit(ID, SP_FIFO1_SINK_REG, SP_FIFO1_SINK_BIT);
stall->fifo2 =
!sp_ctrl_getbit(ID, SP_FIFO2_SINK_REG, SP_FIFO2_SINK_BIT);
stall->fifo3 =
!sp_ctrl_getbit(ID, SP_FIFO3_SINK_REG, SP_FIFO3_SINK_BIT);
stall->fifo4 =
!sp_ctrl_getbit(ID, SP_FIFO4_SINK_REG, SP_FIFO4_SINK_BIT);
stall->fifo5 =
!sp_ctrl_getbit(ID, SP_FIFO5_SINK_REG, SP_FIFO5_SINK_BIT);
stall->fifo6 =
!sp_ctrl_getbit(ID, SP_FIFO6_SINK_REG, SP_FIFO6_SINK_BIT);
stall->fifo7 =
!sp_ctrl_getbit(ID, SP_FIFO7_SINK_REG, SP_FIFO7_SINK_BIT);
stall->fifo8 =
!sp_ctrl_getbit(ID, SP_FIFO8_SINK_REG, SP_FIFO8_SINK_BIT);
stall->fifo9 =
!sp_ctrl_getbit(ID, SP_FIFO9_SINK_REG, SP_FIFO9_SINK_BIT);
stall->fifoa =
!sp_ctrl_getbit(ID, SP_FIFOA_SINK_REG, SP_FIFOA_SINK_BIT);
stall->dmem =
!sp_ctrl_getbit(ID, SP_DMEM_SINK_REG, SP_DMEM_SINK_BIT);
stall->control_master =
!sp_ctrl_getbit(ID, SP_CTRL_MT_SINK_REG, SP_CTRL_MT_SINK_BIT);
stall->icache_master =
!sp_ctrl_getbit(ID, SP_ICACHE_MT_SINK_REG,
SP_ICACHE_MT_SINK_BIT);
return;
}
void
sh_css_metrics_sample_pcs(void)
{
bool stall;
unsigned int pc;
unsigned int msink;
#if SUSPEND
unsigned int sc = 0;
unsigned int stopped_sc = 0;
unsigned int resume_sc = 0;
#endif
#if MULTIPLE_PCS
int i;
unsigned int pc_tab[NOF_PCS] ;
for (i = 0; i < NOF_PCS; i++)
pc_tab[i] = 0;
#endif
if (!pc_histogram_enabled)
return;
if (isp_histogram) {
#if SUSPEND
/* STOP the ISP */
isp_ctrl_store(ISP0_ID, ISP_SC_REG, STOP_MASK);
#endif
msink = isp_ctrl_load(ISP0_ID, ISP_CTRL_SINK_REG);
#if MULTIPLE_PCS
for (i = 0; i < NOF_PCS; i++)
pc_tab[i] = isp_ctrl_load(ISP0_ID, ISP_PC_REG);
#else
pc = isp_ctrl_load(ISP0_ID, ISP_PC_REG);
#endif
#if SUSPEND
/* RESUME the ISP */
isp_ctrl_store(ISP0_ID, ISP_SC_REG, RESUME_MASK);
#endif
isp_histogram->msink[pc] &= msink;
stall = (msink != 0x7FF);
if (stall)
isp_histogram->stall[pc]++;
else
isp_histogram->run[pc]++;
#if MULTIPLE_PCS
printk(KERN_INFO "msink = 0%X\n", msink);
for (i = 0; i < NOF_PCS; i++)
printk(KERN_INFO "PC = %d ", pc_tab[i]);
printk(KERN_INFO "\n");
#endif
}
if (sp_histogram && 0) {
msink = sp_ctrl_load(SP0_ID, SP_CTRL_SINK_REG);
pc = sp_ctrl_load(SP0_ID, SP_PC_REG);
sp_histogram->msink[pc] &= msink;
stall = (msink != 0x7FF);
if (stall)
sp_histogram->stall[pc]++;
else
sp_histogram->run[pc]++;
}
}
