95 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_is_motion_on()  local
97 	return (solo_dev->motion_mask >> solo_enc->ch) & 1;  in solo_is_motion_on()
102 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_motion_detected()  local
108 	if (solo_reg_read(solo_dev, SOLO_VI_MOT_STATUS) & ch_mask) {  in solo_motion_detected()
109 		solo_reg_write(solo_dev, SOLO_VI_MOT_CLEAR, ch_mask);  in solo_motion_detected()
119 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_motion_toggle()  local
126 		solo_dev->motion_mask |= mask;  in solo_motion_toggle()
128 		solo_dev->motion_mask &= ~mask;  in solo_motion_toggle()
130 	solo_reg_write(solo_dev, SOLO_VI_MOT_CLEAR, mask);  in solo_motion_toggle()
132 	solo_reg_write(solo_dev, SOLO_VI_MOT_ADR,  in solo_motion_toggle()
133 		       SOLO_VI_MOTION_EN(solo_dev->motion_mask) |  in solo_motion_toggle()
134 		       (SOLO_MOTION_EXT_ADDR(solo_dev) >> 16));  in solo_motion_toggle()
141 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_update_mode()  local
146 	solo_enc->bw_weight = max(solo_dev->fps / solo_enc->interval, 1);  in solo_update_mode()
149 		solo_enc->width = solo_dev->video_hsize >> 1;  in solo_update_mode()
150 		solo_enc->height = solo_dev->video_vsize;  in solo_update_mode()
151 		if (solo_dev->type == SOLO_DEV_6110) {  in solo_update_mode()
152 			if (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) {  in solo_update_mode()
160 			if (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) {  in solo_update_mode()
169 		solo_enc->width = solo_dev->video_hsize;  in solo_update_mode()
170 		solo_enc->height = solo_dev->video_vsize << 1;  in solo_update_mode()
172 		if (solo_dev->type == SOLO_DEV_6110) {  in solo_update_mode()
173 			if (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) {  in solo_update_mode()
181 			if (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) {  in solo_update_mode()
194 	if (solo_dev->type == SOLO_DEV_6010) {  in solo_update_mode()
195 		u16 fps = solo_dev->fps * 1000;  in solo_update_mode()
218 	       jpeg_dqt[solo_g_jpeg_qp(solo_dev, solo_enc->ch)], DQT_LEN);  in solo_update_mode()
224 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enc_on()  local
230 	if (solo_enc->bw_weight > solo_dev->enc_bw_remain)  in solo_enc_on()
233 	solo_dev->enc_bw_remain -= solo_enc->bw_weight;  in solo_enc_on()
236 		solo_reg_write(solo_dev, SOLO_CAP_CH_COMP_ENA_E(ch), 1);  in solo_enc_on()
239 	solo_reg_write(solo_dev, SOLO_CAP_CH_SCALE(ch), 0);  in solo_enc_on()
242 	solo_reg_write(solo_dev, SOLO_VE_CH_INTL(ch),  in solo_enc_on()
251 	solo_reg_write(solo_dev, SOLO_VE_CH_GOP(ch), solo_enc->gop);  in solo_enc_on()
252 	solo_reg_write(solo_dev, SOLO_VE_CH_QP(ch), solo_enc->qp);  in solo_enc_on()
253 	solo_reg_write(solo_dev, SOLO_CAP_CH_INTV(ch), interval);  in solo_enc_on()
256 	solo_reg_write(solo_dev, SOLO_VE_CH_GOP_E(ch), solo_enc->gop);  in solo_enc_on()
257 	solo_reg_write(solo_dev, SOLO_VE_CH_QP_E(ch), solo_enc->qp);  in solo_enc_on()
258 	solo_reg_write(solo_dev, SOLO_CAP_CH_INTV_E(ch), interval);  in solo_enc_on()
261 	solo_reg_write(solo_dev, SOLO_CAP_CH_SCALE(ch), solo_enc->mode);  in solo_enc_on()
268 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enc_off()  local
270 	solo_dev->enc_bw_remain += solo_enc->bw_weight;  in solo_enc_off()
272 	solo_reg_write(solo_dev, SOLO_CAP_CH_SCALE(solo_enc->ch), 0);  in solo_enc_off()
273 	solo_reg_write(solo_dev, SOLO_CAP_CH_COMP_ENA_E(solo_enc->ch), 0);  in solo_enc_off()
276 static int enc_get_mpeg_dma(struct solo_dev *solo_dev, dma_addr_t dma,  in enc_get_mpeg_dma()  argument
281 	if (off > SOLO_MP4E_EXT_SIZE(solo_dev))  in enc_get_mpeg_dma()
285 	if (off + size <= SOLO_MP4E_EXT_SIZE(solo_dev)) {  in enc_get_mpeg_dma()
286 		return solo_p2m_dma_t(solo_dev, 0, dma,  in enc_get_mpeg_dma()
287 				      SOLO_MP4E_EXT_ADDR(solo_dev) + off, size,  in enc_get_mpeg_dma()
292 	ret = solo_p2m_dma_t(solo_dev, 0, dma,  in enc_get_mpeg_dma()
293 			     SOLO_MP4E_EXT_ADDR(solo_dev) + off,  in enc_get_mpeg_dma()
294 			     SOLO_MP4E_EXT_SIZE(solo_dev) - off, 0, 0);  in enc_get_mpeg_dma()
297 		ret = solo_p2m_dma_t(solo_dev, 0,  in enc_get_mpeg_dma()
298 			     dma + SOLO_MP4E_EXT_SIZE(solo_dev) - off,  in enc_get_mpeg_dma()
299 			     SOLO_MP4E_EXT_ADDR(solo_dev),  in enc_get_mpeg_dma()
300 			     size + off - SOLO_MP4E_EXT_SIZE(solo_dev), 0, 0);  in enc_get_mpeg_dma()
312 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_send_desc()  local
354 			ret = solo_p2m_dma_t(solo_dev, 0, dma, base + off,  in solo_send_desc()
359 			ret = solo_p2m_dma_t(solo_dev, 0, dma + left, base,  in solo_send_desc()
377 			ret = solo_p2m_dma_desc(solo_dev, solo_enc->desc_items,  in solo_send_desc()
389 	return solo_p2m_dma_desc(solo_dev, solo_enc->desc_items,  in solo_send_desc()
453 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_fill_jpeg()  local
466 			     vop_jpeg_offset(vh) - SOLO_JPEG_EXT_ADDR(solo_dev),  in solo_fill_jpeg()
467 			     frame_size, SOLO_JPEG_EXT_ADDR(solo_dev),  in solo_fill_jpeg()
468 			     SOLO_JPEG_EXT_SIZE(solo_dev));  in solo_fill_jpeg()
475 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_fill_mpeg()  local
497 	frame_off = (vop_mpeg_offset(vh) - SOLO_MP4E_EXT_ADDR(solo_dev) +  in solo_fill_mpeg()
498 		sizeof(*vh)) % SOLO_MP4E_EXT_SIZE(solo_dev);  in solo_fill_mpeg()
502 			SOLO_MP4E_EXT_ADDR(solo_dev),  in solo_fill_mpeg()
503 			SOLO_MP4E_EXT_SIZE(solo_dev));  in solo_fill_mpeg()
573 void solo_enc_v4l2_isr(struct solo_dev *solo_dev)  in solo_enc_v4l2_isr()  argument
575 	wake_up_interruptible_all(&solo_dev->ring_thread_wait);  in solo_enc_v4l2_isr()
578 static void solo_handle_ring(struct solo_dev *solo_dev)  in solo_handle_ring()  argument
588 		cur_q = solo_reg_read(solo_dev, SOLO_VE_STATE(11)) & 0xff;  in solo_handle_ring()
589 		if (cur_q == solo_dev->enc_idx)  in solo_handle_ring()
592 		mpeg_current = solo_reg_read(solo_dev,  in solo_handle_ring()
593 					SOLO_VE_MPEG4_QUE(solo_dev->enc_idx));  in solo_handle_ring()
594 		solo_dev->enc_idx = (solo_dev->enc_idx + 1) % MP4_QS;  in solo_handle_ring()
605 		solo_enc = solo_dev->v4l2_enc[ch];  in solo_handle_ring()
607 			dev_err(&solo_dev->pdev->dev,  in solo_handle_ring()
613 		if (enc_get_mpeg_dma(solo_dev, solo_dev->vh_dma, off,  in solo_handle_ring()
617 		enc_buf.vh = solo_dev->vh_buf;  in solo_handle_ring()
621 			SOLO_MP4E_EXT_ADDR(solo_dev) + off)  in solo_handle_ring()
635 	struct solo_dev *solo_dev = data;  in solo_ring_thread()  local
639 	add_wait_queue(&solo_dev->ring_thread_wait, &wait);  in solo_ring_thread()
646 		solo_handle_ring(solo_dev);  in solo_ring_thread()
650 	remove_wait_queue(&solo_dev->ring_thread_wait, &wait);  in solo_ring_thread()
682 static int solo_ring_start(struct solo_dev *solo_dev)  in solo_ring_start()  argument
684 	solo_dev->ring_thread = kthread_run(solo_ring_thread, solo_dev,  in solo_ring_start()
686 	if (IS_ERR(solo_dev->ring_thread)) {  in solo_ring_start()
687 		int err = PTR_ERR(solo_dev->ring_thread);  in solo_ring_start()
689 		solo_dev->ring_thread = NULL;  in solo_ring_start()
693 	solo_irq_on(solo_dev, SOLO_IRQ_ENCODER);  in solo_ring_start()
698 static void solo_ring_stop(struct solo_dev *solo_dev)  in solo_ring_stop()  argument
700 	if (solo_dev->ring_thread) {  in solo_ring_stop()
701 		kthread_stop(solo_dev->ring_thread);  in solo_ring_stop()
702 		solo_dev->ring_thread = NULL;  in solo_ring_stop()
705 	solo_irq_off(solo_dev, SOLO_IRQ_ENCODER);  in solo_ring_stop()
778 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enc_enum_input()  local
788 	if (!tw28_get_video_status(solo_dev, solo_enc->ch))  in solo_enc_enum_input()
815 	int dev_type = solo_enc->solo_dev->type;  in solo_enc_enum_fmt_cap()
848 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enc_try_fmt_cap()  local
851 	if (solo_valid_pixfmt(pix->pixelformat, solo_dev->type))  in solo_enc_try_fmt_cap()
854 	if (pix->width < solo_dev->video_hsize ||  in solo_enc_try_fmt_cap()
855 	    pix->height < solo_dev->video_vsize << 1) {  in solo_enc_try_fmt_cap()
857 		pix->width = solo_dev->video_hsize >> 1;  in solo_enc_try_fmt_cap()
858 		pix->height = solo_dev->video_vsize;  in solo_enc_try_fmt_cap()
861 		pix->width = solo_dev->video_hsize;  in solo_enc_try_fmt_cap()
862 		pix->height = solo_dev->video_vsize << 1;  in solo_enc_try_fmt_cap()
887 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enc_set_fmt_cap()  local
898 	if (pix->width == solo_dev->video_hsize)  in solo_enc_set_fmt_cap()
940 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enc_g_std()  local
942 	if (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC)  in solo_enc_g_std()
953 	return solo_set_video_type(solo_enc->solo_dev, std & V4L2_STD_625_50);  in solo_enc_s_std()
960 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enum_framesizes()  local
962 	if (solo_valid_pixfmt(fsize->pixel_format, solo_dev->type))  in solo_enum_framesizes()
967 		fsize->discrete.width = solo_dev->video_hsize >> 1;  in solo_enum_framesizes()
968 		fsize->discrete.height = solo_dev->video_vsize;  in solo_enum_framesizes()
971 		fsize->discrete.width = solo_dev->video_hsize;  in solo_enum_framesizes()
972 		fsize->discrete.height = solo_dev->video_vsize << 1;  in solo_enum_framesizes()
987 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_enum_frameintervals()  local
989 	if (solo_valid_pixfmt(fintv->pixel_format, solo_dev->type))  in solo_enum_frameintervals()
993 	if ((fintv->width != solo_dev->video_hsize >> 1 ||  in solo_enum_frameintervals()
994 	     fintv->height != solo_dev->video_vsize) &&  in solo_enum_frameintervals()
995 	    (fintv->width != solo_dev->video_hsize ||  in solo_enum_frameintervals()
996 	     fintv->height != solo_dev->video_vsize << 1))  in solo_enum_frameintervals()
1002 	fintv->stepwise.min.denominator = solo_dev->fps;  in solo_enum_frameintervals()
1005 	fintv->stepwise.max.denominator = solo_dev->fps;  in solo_enum_frameintervals()
1008 	fintv->stepwise.step.denominator = solo_dev->fps;  in solo_enum_frameintervals()
1021 	cp->timeperframe.denominator = solo_enc->solo_dev->fps;  in solo_g_parm()
1044 	u8 fps = solo_enc->solo_dev->fps;  in solo_s_parm()
1058 	struct solo_dev *solo_dev = solo_enc->solo_dev;  in solo_s_ctrl()  local
1067 		return tw28_set_ctrl_val(solo_dev, ctrl->id, solo_enc->ch,  in solo_s_ctrl()
1071 		solo_reg_write(solo_dev, SOLO_VE_CH_GOP(solo_enc->ch), solo_enc->gop);  in solo_s_ctrl()
1072 		solo_reg_write(solo_dev, SOLO_VE_CH_GOP_E(solo_enc->ch), solo_enc->gop);  in solo_s_ctrl()
1076 		solo_reg_write(solo_dev, SOLO_VE_CH_QP(solo_enc->ch), solo_enc->qp);  in solo_s_ctrl()
1077 		solo_reg_write(solo_dev, SOLO_VE_CH_QP_E(solo_enc->ch), solo_enc->qp);  in solo_s_ctrl()
1083 		return solo_set_motion_threshold(solo_dev, solo_enc->ch,  in solo_s_ctrl()
1090 				err = solo_set_motion_threshold(solo_dev, solo_enc->ch,  in solo_s_ctrl()
1093 				err = solo_set_motion_block(solo_dev, solo_enc->ch,  in solo_s_ctrl()
1102 			return solo_set_motion_block(solo_dev, solo_enc->ch,  in solo_s_ctrl()
1206 static struct solo_enc_dev *solo_enc_alloc(struct solo_dev *solo_dev,  in solo_enc_alloc()  argument
1227 	if (tw28_has_sharpness(solo_dev, ch))  in solo_enc_alloc()
1231 			V4L2_CID_MPEG_VIDEO_GOP_SIZE, 1, 255, 1, solo_dev->fps);  in solo_enc_alloc()
1249 	solo_enc->solo_dev = solo_dev;  in solo_enc_alloc()
1254 	solo_enc->fmt = (solo_dev->type == SOLO_DEV_6010) ?  in solo_enc_alloc()
1259 	solo_enc->gop = solo_dev->fps;  in solo_enc_alloc()
1273 	solo_enc->vidq.dev = &solo_dev->pdev->dev;  in solo_enc_alloc()
1286 	solo_enc->desc_items = dma_alloc_coherent(&solo_dev->pdev->dev,  in solo_enc_alloc()
1300 	solo_enc->vfd->v4l2_dev = &solo_dev->v4l2_dev;  in solo_enc_alloc()
1310 		 "%s-enc (%i/%i)", SOLO6X10_NAME, solo_dev->vfd->num,  in solo_enc_alloc()
1318 	dma_free_coherent(&solo_enc->solo_dev->pdev->dev,  in solo_enc_alloc()
1332 	dma_free_coherent(&solo_enc->solo_dev->pdev->dev,  in solo_enc_free()
1340 int solo_enc_v4l2_init(struct solo_dev *solo_dev, unsigned nr)  in solo_enc_v4l2_init()  argument
1344 	init_waitqueue_head(&solo_dev->ring_thread_wait);  in solo_enc_v4l2_init()
1346 	solo_dev->vh_size = sizeof(vop_header);  in solo_enc_v4l2_init()
1347 	solo_dev->vh_buf = dma_alloc_coherent(&solo_dev->pdev->dev,  in solo_enc_v4l2_init()
1348 					      solo_dev->vh_size,  in solo_enc_v4l2_init()
1349 					      &solo_dev->vh_dma, GFP_KERNEL);  in solo_enc_v4l2_init()
1350 	if (solo_dev->vh_buf == NULL)  in solo_enc_v4l2_init()
1353 	for (i = 0; i < solo_dev->nr_chans; i++) {  in solo_enc_v4l2_init()
1354 		solo_dev->v4l2_enc[i] = solo_enc_alloc(solo_dev, i, nr);  in solo_enc_v4l2_init()
1355 		if (IS_ERR(solo_dev->v4l2_enc[i]))  in solo_enc_v4l2_init()
1359 	if (i != solo_dev->nr_chans) {  in solo_enc_v4l2_init()
1360 		int ret = PTR_ERR(solo_dev->v4l2_enc[i]);  in solo_enc_v4l2_init()
1363 			solo_enc_free(solo_dev->v4l2_enc[i]);  in solo_enc_v4l2_init()
1364 		dma_free_coherent(&solo_dev->pdev->dev, solo_dev->vh_size,  in solo_enc_v4l2_init()
1365 				  solo_dev->vh_buf, solo_dev->vh_dma);  in solo_enc_v4l2_init()
1366 		solo_dev->vh_buf = NULL;  in solo_enc_v4l2_init()
1370 	if (solo_dev->type == SOLO_DEV_6010)  in solo_enc_v4l2_init()
1371 		solo_dev->enc_bw_remain = solo_dev->fps * 4 * 4;  in solo_enc_v4l2_init()
1373 		solo_dev->enc_bw_remain = solo_dev->fps * 4 * 5;  in solo_enc_v4l2_init()
1375 	dev_info(&solo_dev->pdev->dev, "Encoders as /dev/video%d-%d\n",  in solo_enc_v4l2_init()
1376 		 solo_dev->v4l2_enc[0]->vfd->num,  in solo_enc_v4l2_init()
1377 		 solo_dev->v4l2_enc[solo_dev->nr_chans - 1]->vfd->num);  in solo_enc_v4l2_init()
1379 	return solo_ring_start(solo_dev);  in solo_enc_v4l2_init()
1382 void solo_enc_v4l2_exit(struct solo_dev *solo_dev)  in solo_enc_v4l2_exit()  argument
1386 	solo_ring_stop(solo_dev);  in solo_enc_v4l2_exit()
1388 	for (i = 0; i < solo_dev->nr_chans; i++)  in solo_enc_v4l2_exit()
1389 		solo_enc_free(solo_dev->v4l2_enc[i]);  in solo_enc_v4l2_exit()
1391 	if (solo_dev->vh_buf)  in solo_enc_v4l2_exit()
1392 		dma_free_coherent(&solo_dev->pdev->dev, solo_dev->vh_size,  in solo_enc_v4l2_exit()
1393 				  solo_dev->vh_buf, solo_dev->vh_dma);  in solo_enc_v4l2_exit()