hive_isp_css_common/host/input_system.c

44 static void receiver_rst(const rx_ID_t ID);
45 static void input_system_network_rst(const input_system_ID_t ID);
48     const input_system_ID_t			ID,
53     const input_system_ID_t			ID,
58     const input_system_ID_t			ID,
63     const input_system_ID_t			ID,
82 static void gp_device_rst(const gp_device_ID_t		ID);
84 static void input_selector_cfg_for_sensor(const gp_device_ID_t	ID);
86 static void input_switch_rst(const gp_device_ID_t	ID);
89     const gp_device_ID_t				ID,
94     const rx_ID_t			ID,
105 	assert(ID < N_RX_ID);
139 	receiver_reg_store(ID, addr, reg);
143     const rx_ID_t			ID,
147 	hrt_data	reg = receiver_port_reg_load(ID, port_ID,
156 	receiver_port_reg_store(ID, port_ID,
161     const rx_ID_t			ID,
164 	hrt_data	reg = receiver_port_reg_load(ID, port_ID,
170     const rx_ID_t			ID,
174 	receiver_port_reg_store(ID,
179     const rx_ID_t			ID,
182 	return receiver_port_reg_load(ID,
187     const rx_ID_t			ID,
191 	receiver_port_reg_store(ID,
199     const rx_ID_t				ID)
203 	assert(ID < N_RX_ID);
207 		receiver_port_enable(ID, port_id, false);
214 static void gp_device_rst(const gp_device_ID_t		ID)
216 	assert(ID < N_GP_DEVICE_ID);
218 	gp_device_reg_store(ID, _REG_GP_SYNCGEN_ENABLE_ADDR, ZERO);
219 	// gp_device_reg_store(ID, _REG_GP_SYNCGEN_FREE_RUNNING_ADDR, ZERO);
220 	// gp_device_reg_store(ID, _REG_GP_SYNCGEN_PAUSE_ADDR, ONE);
221 	// gp_device_reg_store(ID, _REG_GP_NR_FRAMES_ADDR, ZERO);
222 	// gp_device_reg_store(ID, _REG_GP_SYNGEN_NR_PIX_ADDR, ZERO);
223 	// gp_device_reg_store(ID, _REG_GP_SYNGEN_NR_PIX_ADDR, ZERO);
224 	// gp_device_reg_store(ID, _REG_GP_SYNGEN_NR_LINES_ADDR, ZERO);
225 	// gp_device_reg_store(ID, _REG_GP_SYNGEN_HBLANK_CYCLES_ADDR, ZERO);
226 	// gp_device_reg_store(ID, _REG_GP_SYNGEN_VBLANK_CYCLES_ADDR, ZERO);
228 //	gp_device_reg_store(ID, _REG_GP_ISEL_SOF_ADDR, ZERO);
229 //	gp_device_reg_store(ID, _REG_GP_ISEL_EOF_ADDR, ZERO);
230 //	gp_device_reg_store(ID, _REG_GP_ISEL_SOL_ADDR, ZERO);
231 //	gp_device_reg_store(ID, _REG_GP_ISEL_EOL_ADDR, ZERO);
232 	gp_device_reg_store(ID, _REG_GP_ISEL_LFSR_ENABLE_ADDR, ZERO);
233 	gp_device_reg_store(ID, _REG_GP_ISEL_LFSR_ENABLE_B_ADDR, ZERO);
234 	gp_device_reg_store(ID, _REG_GP_ISEL_LFSR_RESET_VALUE_ADDR, ZERO);
235 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_ENABLE_ADDR, ZERO);
236 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_ENABLE_B_ADDR, ZERO);
237 	gp_device_reg_store(ID, _REG_GP_ISEL_HOR_CNT_MASK_ADDR, ZERO);
238 	gp_device_reg_store(ID, _REG_GP_ISEL_VER_CNT_MASK_ADDR, ZERO);
239 	gp_device_reg_store(ID, _REG_GP_ISEL_XY_CNT_MASK_ADDR, ZERO);
240 	gp_device_reg_store(ID, _REG_GP_ISEL_HOR_CNT_DELTA_ADDR, ZERO);
241 	gp_device_reg_store(ID, _REG_GP_ISEL_VER_CNT_DELTA_ADDR, ZERO);
242 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_MODE_ADDR, ZERO);
243 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_RED1_ADDR, ZERO);
244 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_GREEN1_ADDR, ZERO);
245 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_BLUE1_ADDR, ZERO);
246 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_RED2_ADDR, ZERO);
247 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_GREEN2_ADDR, ZERO);
248 	gp_device_reg_store(ID, _REG_GP_ISEL_TPG_BLUE2_ADDR, ZERO);
249 	//gp_device_reg_store(ID, _REG_GP_ISEL_CH_ID_ADDR, ZERO);
250 	//gp_device_reg_store(ID, _REG_GP_ISEL_FMT_TYPE_ADDR, ZERO);
251 	gp_device_reg_store(ID, _REG_GP_ISEL_DATA_SEL_ADDR, ZERO);
252 	gp_device_reg_store(ID, _REG_GP_ISEL_SBAND_SEL_ADDR, ZERO);
253 	gp_device_reg_store(ID, _REG_GP_ISEL_SYNC_SEL_ADDR, ZERO);
254 	//	gp_device_reg_store(ID, _REG_GP_SYNCGEN_HOR_CNT_ADDR, ZERO);
255 	//	gp_device_reg_store(ID, _REG_GP_SYNCGEN_VER_CNT_ADDR, ZERO);
256 	//	gp_device_reg_store(ID, _REG_GP_SYNCGEN_FRAME_CNT_ADDR, ZERO);
257 	gp_device_reg_store(ID, _REG_GP_SOFT_RESET_ADDR,
261 static void input_selector_cfg_for_sensor(const gp_device_ID_t ID)
263 	assert(ID < N_GP_DEVICE_ID);
265 	gp_device_reg_store(ID, _REG_GP_ISEL_SOF_ADDR, ONE);
266 	gp_device_reg_store(ID, _REG_GP_ISEL_EOF_ADDR, ONE);
267 	gp_device_reg_store(ID, _REG_GP_ISEL_SOL_ADDR, ONE);
268 	gp_device_reg_store(ID, _REG_GP_ISEL_EOL_ADDR, ONE);
269 	gp_device_reg_store(ID, _REG_GP_ISEL_CH_ID_ADDR, ZERO);
270 	gp_device_reg_store(ID, _REG_GP_ISEL_FMT_TYPE_ADDR, ZERO);
271 	gp_device_reg_store(ID, _REG_GP_ISEL_DATA_SEL_ADDR, ZERO);
272 	gp_device_reg_store(ID, _REG_GP_ISEL_SBAND_SEL_ADDR, ZERO);
273 	gp_device_reg_store(ID, _REG_GP_ISEL_SYNC_SEL_ADDR, ZERO);
274 	gp_device_reg_store(ID, _REG_GP_SOFT_RESET_ADDR, ZERO);
277 static void input_switch_rst(const gp_device_ID_t ID)
281 	assert(ID < N_GP_DEVICE_ID);
286 		gp_device_reg_store(ID, addr, ZERO);
290 	gp_device_reg_store(ID,
296     const gp_device_ID_t			ID,
301 	assert(ID < N_GP_DEVICE_ID);
308 		gp_device_reg_store(ID,
314 	gp_device_reg_store(ID,
319 static void input_system_network_rst(const input_system_ID_t ID)
324 	input_system_sub_system_reg_store(ID,
328 	input_system_sub_system_reg_store(ID,
332 	input_system_sub_system_reg_store(ID,
338 	input_system_sub_system_reg_store(ID,
346 		input_system_sub_system_reg_store(ID,
355 		input_system_sub_system_reg_store(ID,
367 		input_system_sub_system_reg_store(ID,
577     const input_system_ID_t			ID,
581 	assert(ID < N_INPUT_SYSTEM_ID);
586 	input_system_sub_system_reg_store(ID,
590 	input_system_sub_system_reg_store(ID,
594 	input_system_sub_system_reg_store(ID,
601     const input_system_ID_t			ID,
605 	assert(ID < N_INPUT_SYSTEM_ID);
609 	input_system_sub_system_reg_store(ID,
613 	input_system_sub_system_reg_store(ID,
617 	input_system_sub_system_reg_store(ID,
624     const input_system_ID_t			ID,
628 	assert(ID < N_INPUT_SYSTEM_ID);
632 	input_system_sub_system_reg_store(ID,
636 	input_system_sub_system_reg_store(ID,
640 	input_system_sub_system_reg_store(ID,
645 	input_system_sub_system_reg_store(ID,
649 	input_system_sub_system_reg_store(ID,
653 	input_system_sub_system_reg_store(ID,
658 	input_system_sub_system_reg_store(ID,
662 	input_system_sub_system_reg_store(ID,
666 	input_system_sub_system_reg_store(ID,
671 	input_system_sub_system_reg_store(ID,
675 	input_system_sub_system_reg_store(ID,
679 	input_system_sub_system_reg_store(ID,
683 	input_system_sub_system_reg_store(ID,
690     const input_system_ID_t				ID,
695 	assert(ID < N_INPUT_SYSTEM_ID);
699 	input_system_sub_system_reg_store(ID,
703 	input_system_sub_system_reg_store(ID,
707 	input_system_sub_system_reg_store(ID,
713 	input_system_sub_system_reg_store(ID,
721 		capture_unit_configure(ID,
723 				       &cfg->ctrl_unit_cfg[ID].buffer_mipi[sub_id - CAPTURE_UNIT0_ID]);
729 		acquisition_unit_configure(ID,
740 		ctrl_unit_configure(ID,