starfive/camss/stf-capture.c

58 static inline struct stf_capture *to_stf_capture(struct stfcamss_video *video)
60 	return container_of(video, struct stf_capture, video);
76 static void stf_init_addrs(struct stfcamss_video *video)
78 	struct stf_capture *cap = to_stf_capture(video);
91 		stf_set_raw_addr(video->stfcamss, addr0);
93 		stf_set_yuv_addr(video->stfcamss, addr0, addr1);
110 static void stf_cap_s_cfg(struct stfcamss_video *video)
112 	struct stf_capture *cap = to_stf_capture(video);
130 	stf_init_addrs(video);
135 static int stf_cap_s_cleanup(struct stfcamss_video *video)
137 	struct stf_capture *cap = to_stf_capture(video);
150 static void stf_wr_data_en(struct stfcamss_video *video)
152 	struct stf_capture *cap = to_stf_capture(video);
153 	struct stfcamss *stfcamss = cap->video.stfcamss;
158 static void stf_wr_irq_enable(struct stfcamss_video *video)
160 	struct stf_capture *cap = to_stf_capture(video);
161 	struct stfcamss *stfcamss = cap->video.stfcamss;
166 static void stf_wr_irq_disable(struct stfcamss_video *video)
168 	struct stf_capture *cap = to_stf_capture(video);
169 	struct stfcamss *stfcamss = cap->video.stfcamss;
176 static void stf_channel_set(struct stfcamss_video *video)
178 	struct stf_capture *cap = to_stf_capture(video);
179 	struct stfcamss *stfcamss = cap->video.stfcamss;
217 static void stf_capture_start(struct stfcamss_video *video)
219 	struct stf_capture *cap = to_stf_capture(video);
221 	stf_channel_set(video);
223 		stf_wr_irq_enable(video);
224 		stf_wr_data_en(video);
227 	stf_cap_s_cfg(video);
230 static void stf_capture_stop(struct stfcamss_video *video)
232 	struct stf_capture *cap = to_stf_capture(video);
235 		stf_wr_irq_disable(video);
237 	stf_cap_s_cleanup(video);
251 	cap->video.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
252 	cap->video.stfcamss = stfcamss;
253 	cap->video.bpl_alignment = 16 * 8;
256 		cap->video.formats = stf_wr_fmts;
257 		cap->video.nformats = ARRAY_SIZE(stf_wr_fmts);
258 		cap->video.bpl_alignment = 8;
260 		cap->video.formats = stf_isp_fmts;
261 		cap->video.nformats = ARRAY_SIZE(stf_isp_fmts);
262 		cap->video.bpl_alignment = 1;
321 static void stf_buf_update_on_new(struct stfcamss_video *video,
324 	struct stf_capture *cap = to_stf_capture(video);
334 			stf_init_addrs(video);
397 	struct stfcamss *stfcamss = cap->video.stfcamss;
512 static int stf_queue_buffer(struct stfcamss_video *video,
515 	struct stf_capture *cap = to_stf_capture(video);
520 	stf_buf_update_on_new(video, buf);
526 static int stf_flush_buffers(struct stfcamss_video *video,
529 	struct stf_capture *cap = to_stf_capture(video);
563 	if (!video_is_registered(&cap->video.vdev))
566 	media_entity_cleanup(&cap->video.vdev.entity);
567 	vb2_video_unregister_device(&cap->video.vdev);
589 		capture->video.ops = &stf_capture_ops;
592 		ret = stf_video_register(&capture->video, v4l2_dev,
596 				"Failed to register video node: %d\n", ret);