Lines Matching +full:reg +full:- +full:spacing
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 // Copyright (c) 2019-2020 Intel Corporation
10 #include <linux/dma-mapping.h>
22 #include <linux/v4l2-controls.h>
26 #include <media/v4l2-ctrls.h>
27 #include <media/v4l2-dev.h>
28 #include <media/v4l2-device.h>
29 #include <media/v4l2-dv-timings.h>
30 #include <media/v4l2-event.h>
31 #include <media/v4l2-ioctl.h>
32 #include <media/videobuf2-dma-contig.h>
34 #define DEVICE_NAME "aspeed-video"
408 base = 256 * i; /* AST HW requires this header spacing */ in aspeed_video_init_jpeg_table()
425 static void aspeed_video_update(struct aspeed_video *video, u32 reg, u32 clear, in aspeed_video_update() argument
428 u32 t = readl(video->base + reg); in aspeed_video_update()
433 writel(t, video->base + reg); in aspeed_video_update()
434 dev_dbg(video->dev, "update %03x[%08x -> %08x]\n", reg, before, in aspeed_video_update()
435 readl(video->base + reg)); in aspeed_video_update()
438 static u32 aspeed_video_read(struct aspeed_video *video, u32 reg) in aspeed_video_read() argument
440 u32 t = readl(video->base + reg); in aspeed_video_read()
442 dev_dbg(video->dev, "read %03x[%08x]\n", reg, t); in aspeed_video_read()
446 static void aspeed_video_write(struct aspeed_video *video, u32 reg, u32 val) in aspeed_video_write() argument
448 writel(val, video->base + reg); in aspeed_video_write()
449 dev_dbg(video->dev, "write %03x[%08x]\n", reg, in aspeed_video_write()
450 readl(video->base + reg)); in aspeed_video_write()
460 if (video->v4l2_input_status) { in aspeed_video_start_frame()
461 dev_dbg(video->dev, "No signal; don't start frame\n"); in aspeed_video_start_frame()
467 dev_dbg(video->dev, "Engine busy; don't start frame\n"); in aspeed_video_start_frame()
468 return -EBUSY; in aspeed_video_start_frame()
471 spin_lock_irqsave(&video->lock, flags); in aspeed_video_start_frame()
472 buf = list_first_entry_or_null(&video->buffers, in aspeed_video_start_frame()
475 spin_unlock_irqrestore(&video->lock, flags); in aspeed_video_start_frame()
476 dev_dbg(video->dev, "No buffers; don't start frame\n"); in aspeed_video_start_frame()
477 return -EPROTO; in aspeed_video_start_frame()
480 set_bit(VIDEO_FRAME_INPRG, &video->flags); in aspeed_video_start_frame()
481 addr = vb2_dma_contig_plane_dma_addr(&buf->vb.vb2_buf, 0); in aspeed_video_start_frame()
482 spin_unlock_irqrestore(&video->lock, flags); in aspeed_video_start_frame()
503 /* Disable mode detect in order to re-trigger */ in aspeed_video_enable_mode_detect()
513 if (!test_bit(VIDEO_CLOCKS_ON, &video->flags)) in aspeed_video_off()
521 clk_disable(video->eclk); in aspeed_video_off()
522 clk_disable(video->vclk); in aspeed_video_off()
524 clear_bit(VIDEO_CLOCKS_ON, &video->flags); in aspeed_video_off()
529 if (test_bit(VIDEO_CLOCKS_ON, &video->flags)) in aspeed_video_on()
533 clk_enable(video->vclk); in aspeed_video_on()
534 clk_enable(video->eclk); in aspeed_video_on()
536 set_bit(VIDEO_CLOCKS_ON, &video->flags); in aspeed_video_on()
545 spin_lock_irqsave(&video->lock, flags); in aspeed_video_bufs_done()
546 list_for_each_entry(buf, &video->buffers, link) in aspeed_video_bufs_done()
547 vb2_buffer_done(&buf->vb.vb2_buf, state); in aspeed_video_bufs_done()
548 INIT_LIST_HEAD(&video->buffers); in aspeed_video_bufs_done()
549 spin_unlock_irqrestore(&video->lock, flags); in aspeed_video_bufs_done()
554 dev_dbg(video->dev, "Resolution changed; resetting\n"); in aspeed_video_irq_res_change()
556 set_bit(VIDEO_RES_CHANGE, &video->flags); in aspeed_video_irq_res_change()
557 clear_bit(VIDEO_FRAME_INPRG, &video->flags); in aspeed_video_irq_res_change()
559 video->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; in aspeed_video_irq_res_change()
564 schedule_delayed_work(&video->res_work, delay); in aspeed_video_irq_res_change()
574 * re-initialize in aspeed_video_irq()
582 if (test_bit(VIDEO_RES_DETECT, &video->flags)) { in aspeed_video_irq()
588 set_bit(VIDEO_MODE_DETECT_DONE, &video->flags); in aspeed_video_irq()
589 wake_up_interruptible_all(&video->wait); in aspeed_video_irq()
593 * detection; reset the engine and re-initialize in aspeed_video_irq()
604 video->comp_size_read); in aspeed_video_irq()
606 spin_lock(&video->lock); in aspeed_video_irq()
607 clear_bit(VIDEO_FRAME_INPRG, &video->flags); in aspeed_video_irq()
608 buf = list_first_entry_or_null(&video->buffers, in aspeed_video_irq()
612 vb2_set_plane_payload(&buf->vb.vb2_buf, 0, frame_size); in aspeed_video_irq()
614 if (!list_is_last(&buf->link, &video->buffers)) { in aspeed_video_irq()
615 buf->vb.vb2_buf.timestamp = ktime_get_ns(); in aspeed_video_irq()
616 buf->vb.sequence = video->sequence++; in aspeed_video_irq()
617 buf->vb.field = V4L2_FIELD_NONE; in aspeed_video_irq()
618 vb2_buffer_done(&buf->vb.vb2_buf, in aspeed_video_irq()
620 list_del(&buf->link); in aspeed_video_irq()
623 spin_unlock(&video->lock); in aspeed_video_irq()
634 if (test_bit(VIDEO_STREAMING, &video->flags) && buf) in aspeed_video_irq()
661 vsync_counter--; in aspeed_video_check_and_set_polarity()
666 hsync_counter--; in aspeed_video_check_and_set_polarity()
675 video->detected_timings.polarities &= in aspeed_video_check_and_set_polarity()
679 video->detected_timings.polarities |= in aspeed_video_check_and_set_polarity()
685 video->detected_timings.polarities &= in aspeed_video_check_and_set_polarity()
689 video->detected_timings.polarities |= in aspeed_video_check_and_set_polarity()
700 addr->virt = dma_alloc_coherent(video->dev, size, &addr->dma, in aspeed_video_alloc_buf()
702 if (!addr->virt) in aspeed_video_alloc_buf()
705 addr->size = size; in aspeed_video_alloc_buf()
712 dma_free_coherent(video->dev, addr->size, addr->virt, addr->dma); in aspeed_video_free_buf()
713 addr->size = 0; in aspeed_video_free_buf()
714 addr->dma = 0ULL; in aspeed_video_free_buf()
715 addr->virt = NULL; in aspeed_video_free_buf()
719 * Get the minimum HW-supported compression buffer size for the frame size.
720 * Assume worst-case JPEG compression size is 1/8 raw size. This should be
734 video->max_compressed_size = UINT_MAX; in aspeed_video_calc_compressed_size()
743 if (size < video->max_compressed_size) { in aspeed_video_calc_compressed_size()
745 video->max_compressed_size = size; in aspeed_video_calc_compressed_size()
753 dev_dbg(video->dev, "Max compressed size: %x\n", in aspeed_video_calc_compressed_size()
754 video->max_compressed_size); in aspeed_video_calc_compressed_size()
757 #define res_check(v) test_and_clear_bit(VIDEO_MODE_DETECT_DONE, &(v)->flags)
768 struct v4l2_bt_timings *det = &video->detected_timings; in aspeed_video_get_resolution()
770 det->width = MIN_WIDTH; in aspeed_video_get_resolution()
771 det->height = MIN_HEIGHT; in aspeed_video_get_resolution()
772 video->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; in aspeed_video_get_resolution()
781 set_bit(VIDEO_RES_DETECT, &video->flags); in aspeed_video_get_resolution()
786 rc = wait_event_interruptible_timeout(video->wait, in aspeed_video_get_resolution()
790 dev_dbg(video->dev, "Timed out; first mode detect\n"); in aspeed_video_get_resolution()
791 clear_bit(VIDEO_RES_DETECT, &video->flags); in aspeed_video_get_resolution()
799 rc = wait_event_interruptible_timeout(video->wait, in aspeed_video_get_resolution()
802 clear_bit(VIDEO_RES_DETECT, &video->flags); in aspeed_video_get_resolution()
804 dev_dbg(video->dev, "Timed out; second mode detect\n"); in aspeed_video_get_resolution()
813 video->frame_bottom = (src_tb_edge & VE_SRC_TB_EDGE_DET_BOT) >> in aspeed_video_get_resolution()
815 video->frame_top = src_tb_edge & VE_SRC_TB_EDGE_DET_TOP; in aspeed_video_get_resolution()
816 det->vfrontporch = video->frame_top; in aspeed_video_get_resolution()
817 det->vbackporch = ((mds & VE_MODE_DETECT_V_LINES) >> in aspeed_video_get_resolution()
818 VE_MODE_DETECT_V_LINES_SHF) - video->frame_bottom; in aspeed_video_get_resolution()
819 det->vsync = (sync & VE_SYNC_STATUS_VSYNC) >> in aspeed_video_get_resolution()
821 if (video->frame_top > video->frame_bottom) in aspeed_video_get_resolution()
824 video->frame_right = (src_lr_edge & VE_SRC_LR_EDGE_DET_RT) >> in aspeed_video_get_resolution()
826 video->frame_left = src_lr_edge & VE_SRC_LR_EDGE_DET_LEFT; in aspeed_video_get_resolution()
827 det->hfrontporch = video->frame_left; in aspeed_video_get_resolution()
828 det->hbackporch = (mds & VE_MODE_DETECT_H_PIXELS) - in aspeed_video_get_resolution()
829 video->frame_right; in aspeed_video_get_resolution()
830 det->hsync = sync & VE_SYNC_STATUS_HSYNC; in aspeed_video_get_resolution()
831 if (video->frame_left > video->frame_right) in aspeed_video_get_resolution()
838 dev_dbg(video->dev, "Invalid resolution detected\n"); in aspeed_video_get_resolution()
842 det->height = (video->frame_bottom - video->frame_top) + 1; in aspeed_video_get_resolution()
843 det->width = (video->frame_right - video->frame_left) + 1; in aspeed_video_get_resolution()
844 video->v4l2_input_status = 0; in aspeed_video_get_resolution()
847 * Enable mode-detect watchdog, resolution-change watchdog and in aspeed_video_get_resolution()
855 dev_dbg(video->dev, "Got resolution: %dx%d\n", det->width, in aspeed_video_get_resolution()
856 det->height); in aspeed_video_get_resolution()
861 struct v4l2_bt_timings *act = &video->active_timings; in aspeed_video_set_resolution()
862 unsigned int size = act->width * act->height; in aspeed_video_set_resolution()
867 if (video->active_timings.width == 1680) { in aspeed_video_set_resolution()
873 * 64-pixels aligned value to 1680 to minimize memory bandwidth in aspeed_video_set_resolution()
877 1728 << 16 | act->height); in aspeed_video_set_resolution()
878 size += (1728 - 1680) * video->active_timings.height; in aspeed_video_set_resolution()
881 act->width << 16 | act->height); in aspeed_video_set_resolution()
884 act->width << 16 | act->height); in aspeed_video_set_resolution()
885 aspeed_video_write(video, VE_SRC_SCANLINE_OFFSET, act->width * 4); in aspeed_video_set_resolution()
891 video->frame_left - 1) | in aspeed_video_set_resolution()
893 video->frame_right)); in aspeed_video_set_resolution()
895 FIELD_PREP(VE_TGS_FIRST, video->frame_top) | in aspeed_video_set_resolution()
897 video->frame_bottom + 1)); in aspeed_video_set_resolution()
905 if (size != video->srcs[0].size) { in aspeed_video_set_resolution()
906 if (video->srcs[0].size) in aspeed_video_set_resolution()
907 aspeed_video_free_buf(video, &video->srcs[0]); in aspeed_video_set_resolution()
908 if (video->srcs[1].size) in aspeed_video_set_resolution()
909 aspeed_video_free_buf(video, &video->srcs[1]); in aspeed_video_set_resolution()
911 if (!aspeed_video_alloc_buf(video, &video->srcs[0], size)) in aspeed_video_set_resolution()
913 if (!aspeed_video_alloc_buf(video, &video->srcs[1], size)) in aspeed_video_set_resolution()
916 aspeed_video_write(video, VE_SRC0_ADDR, video->srcs[0].dma); in aspeed_video_set_resolution()
917 aspeed_video_write(video, VE_SRC1_ADDR, video->srcs[1].dma); in aspeed_video_set_resolution()
923 dev_err(video->dev, "Failed to allocate source buffers\n"); in aspeed_video_set_resolution()
925 if (video->srcs[0].size) in aspeed_video_set_resolution()
926 aspeed_video_free_buf(video, &video->srcs[0]); in aspeed_video_set_resolution()
932 FIELD_PREP(VE_COMP_CTRL_DCT_LUM, video->jpeg_quality) | in aspeed_video_init_regs()
933 FIELD_PREP(VE_COMP_CTRL_DCT_CHR, video->jpeg_quality | 0x10); in aspeed_video_init_regs()
935 u32 seq_ctrl = video->jpeg_mode; in aspeed_video_init_regs()
937 if (video->frame_rate) in aspeed_video_init_regs()
938 ctrl |= FIELD_PREP(VE_CTRL_FRC, video->frame_rate); in aspeed_video_init_regs()
940 if (video->yuv420) in aspeed_video_init_regs()
954 aspeed_video_write(video, VE_JPEG_ADDR, video->jpeg.dma); in aspeed_video_init_regs()
982 video->active_timings = video->detected_timings; in aspeed_video_start()
985 video->pix_fmt.width = video->active_timings.width; in aspeed_video_start()
986 video->pix_fmt.height = video->active_timings.height; in aspeed_video_start()
987 video->pix_fmt.sizeimage = video->max_compressed_size; in aspeed_video_start()
992 set_bit(VIDEO_STOPPED, &video->flags); in aspeed_video_stop()
993 cancel_delayed_work_sync(&video->res_work); in aspeed_video_stop()
997 if (video->srcs[0].size) in aspeed_video_stop()
998 aspeed_video_free_buf(video, &video->srcs[0]); in aspeed_video_stop()
1000 if (video->srcs[1].size) in aspeed_video_stop()
1001 aspeed_video_free_buf(video, &video->srcs[1]); in aspeed_video_stop()
1003 video->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; in aspeed_video_stop()
1004 video->flags = 0; in aspeed_video_stop()
1010 strscpy(cap->driver, DEVICE_NAME, sizeof(cap->driver)); in aspeed_video_querycap()
1011 strscpy(cap->card, "Aspeed Video Engine", sizeof(cap->card)); in aspeed_video_querycap()
1012 snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s", in aspeed_video_querycap()
1021 if (f->index) in aspeed_video_enum_format()
1022 return -EINVAL; in aspeed_video_enum_format()
1024 f->pixelformat = V4L2_PIX_FMT_JPEG; in aspeed_video_enum_format()
1034 f->fmt.pix = video->pix_fmt; in aspeed_video_get_format()
1044 if (inp->index) in aspeed_video_enum_input()
1045 return -EINVAL; in aspeed_video_enum_input()
1047 strscpy(inp->name, "Host VGA capture", sizeof(inp->name)); in aspeed_video_enum_input()
1048 inp->type = V4L2_INPUT_TYPE_CAMERA; in aspeed_video_enum_input()
1049 inp->capabilities = V4L2_IN_CAP_DV_TIMINGS; in aspeed_video_enum_input()
1050 inp->status = video->v4l2_input_status; in aspeed_video_enum_input()
1065 return -EINVAL; in aspeed_video_set_input()
1075 a->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; in aspeed_video_get_parm()
1076 a->parm.capture.readbuffers = 3; in aspeed_video_get_parm()
1077 a->parm.capture.timeperframe.numerator = 1; in aspeed_video_get_parm()
1078 if (!video->frame_rate) in aspeed_video_get_parm()
1079 a->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; in aspeed_video_get_parm()
1081 a->parm.capture.timeperframe.denominator = video->frame_rate; in aspeed_video_get_parm()
1092 a->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; in aspeed_video_set_parm()
1093 a->parm.capture.readbuffers = 3; in aspeed_video_set_parm()
1095 if (a->parm.capture.timeperframe.numerator) in aspeed_video_set_parm()
1096 frame_rate = a->parm.capture.timeperframe.denominator / in aspeed_video_set_parm()
1097 a->parm.capture.timeperframe.numerator; in aspeed_video_set_parm()
1101 a->parm.capture.timeperframe.denominator = MAX_FRAME_RATE; in aspeed_video_set_parm()
1102 a->parm.capture.timeperframe.numerator = 1; in aspeed_video_set_parm()
1105 if (video->frame_rate != frame_rate) { in aspeed_video_set_parm()
1106 video->frame_rate = frame_rate; in aspeed_video_set_parm()
1119 if (fsize->index) in aspeed_video_enum_framesizes()
1120 return -EINVAL; in aspeed_video_enum_framesizes()
1122 if (fsize->pixel_format != V4L2_PIX_FMT_JPEG) in aspeed_video_enum_framesizes()
1123 return -EINVAL; in aspeed_video_enum_framesizes()
1125 fsize->discrete.width = video->pix_fmt.width; in aspeed_video_enum_framesizes()
1126 fsize->discrete.height = video->pix_fmt.height; in aspeed_video_enum_framesizes()
1127 fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; in aspeed_video_enum_framesizes()
1137 if (fival->index) in aspeed_video_enum_frameintervals()
1138 return -EINVAL; in aspeed_video_enum_frameintervals()
1140 if (fival->width != video->detected_timings.width || in aspeed_video_enum_frameintervals()
1141 fival->height != video->detected_timings.height) in aspeed_video_enum_frameintervals()
1142 return -EINVAL; in aspeed_video_enum_frameintervals()
1144 if (fival->pixel_format != V4L2_PIX_FMT_JPEG) in aspeed_video_enum_frameintervals()
1145 return -EINVAL; in aspeed_video_enum_frameintervals()
1147 fival->type = V4L2_FRMIVAL_TYPE_CONTINUOUS; in aspeed_video_enum_frameintervals()
1149 fival->stepwise.min.denominator = MAX_FRAME_RATE; in aspeed_video_enum_frameintervals()
1150 fival->stepwise.min.numerator = 1; in aspeed_video_enum_frameintervals()
1151 fival->stepwise.max.denominator = 1; in aspeed_video_enum_frameintervals()
1152 fival->stepwise.max.numerator = 1; in aspeed_video_enum_frameintervals()
1153 fival->stepwise.step = fival->stepwise.max; in aspeed_video_enum_frameintervals()
1163 if (timings->bt.width == video->active_timings.width && in aspeed_video_set_dv_timings()
1164 timings->bt.height == video->active_timings.height) in aspeed_video_set_dv_timings()
1167 if (vb2_is_busy(&video->queue)) in aspeed_video_set_dv_timings()
1168 return -EBUSY; in aspeed_video_set_dv_timings()
1170 video->active_timings = timings->bt; in aspeed_video_set_dv_timings()
1174 video->pix_fmt.width = timings->bt.width; in aspeed_video_set_dv_timings()
1175 video->pix_fmt.height = timings->bt.height; in aspeed_video_set_dv_timings()
1176 video->pix_fmt.sizeimage = video->max_compressed_size; in aspeed_video_set_dv_timings()
1178 timings->type = V4L2_DV_BT_656_1120; in aspeed_video_set_dv_timings()
1188 timings->type = V4L2_DV_BT_656_1120; in aspeed_video_get_dv_timings()
1189 timings->bt = video->active_timings; in aspeed_video_get_dv_timings()
1205 if (file->f_flags & O_NONBLOCK) { in aspeed_video_query_dv_timings()
1206 if (test_bit(VIDEO_RES_CHANGE, &video->flags)) in aspeed_video_query_dv_timings()
1207 return -EAGAIN; in aspeed_video_query_dv_timings()
1209 rc = wait_event_interruptible(video->wait, in aspeed_video_query_dv_timings()
1211 &video->flags)); in aspeed_video_query_dv_timings()
1213 return -EINTR; in aspeed_video_query_dv_timings()
1216 timings->type = V4L2_DV_BT_656_1120; in aspeed_video_query_dv_timings()
1217 timings->bt = video->detected_timings; in aspeed_video_query_dv_timings()
1219 return video->v4l2_input_status ? -ENOLINK : 0; in aspeed_video_query_dv_timings()
1240 switch (sub->type) { in aspeed_video_sub_event()
1287 u32 comp_ctrl = FIELD_PREP(VE_COMP_CTRL_DCT_LUM, video->jpeg_quality) | in aspeed_video_update_jpeg_quality()
1288 FIELD_PREP(VE_COMP_CTRL_DCT_CHR, video->jpeg_quality | 0x10); in aspeed_video_update_jpeg_quality()
1297 if (video->jpeg.virt) in aspeed_video_update_subsampling()
1298 aspeed_video_init_jpeg_table(video->jpeg.virt, video->yuv420); in aspeed_video_update_subsampling()
1300 if (video->yuv420) in aspeed_video_update_subsampling()
1308 struct aspeed_video *video = container_of(ctrl->handler, in aspeed_video_set_ctrl()
1312 switch (ctrl->id) { in aspeed_video_set_ctrl()
1314 video->jpeg_quality = ctrl->val; in aspeed_video_set_ctrl()
1318 if (ctrl->val == V4L2_JPEG_CHROMA_SUBSAMPLING_420) { in aspeed_video_set_ctrl()
1319 video->yuv420 = true; in aspeed_video_set_ctrl()
1322 video->yuv420 = false; in aspeed_video_set_ctrl()
1327 return -EINVAL; in aspeed_video_set_ctrl()
1346 if (test_bit(VIDEO_STOPPED, &video->flags)) in aspeed_video_resolution_work()
1353 if (video->detected_timings.width != video->active_timings.width || in aspeed_video_resolution_work()
1354 video->detected_timings.height != video->active_timings.height) { in aspeed_video_resolution_work()
1360 v4l2_event_queue(&video->vdev, &ev); in aspeed_video_resolution_work()
1361 } else if (test_bit(VIDEO_STREAMING, &video->flags)) { in aspeed_video_resolution_work()
1367 clear_bit(VIDEO_RES_CHANGE, &video->flags); in aspeed_video_resolution_work()
1368 wake_up_interruptible_all(&video->wait); in aspeed_video_resolution_work()
1376 mutex_lock(&video->video_lock); in aspeed_video_open()
1380 mutex_unlock(&video->video_lock); in aspeed_video_open()
1387 mutex_unlock(&video->video_lock); in aspeed_video_open()
1397 mutex_lock(&video->video_lock); in aspeed_video_release()
1404 mutex_unlock(&video->video_lock); in aspeed_video_release()
1428 if (sizes[0] < video->max_compressed_size) in aspeed_video_queue_setup()
1429 return -EINVAL; in aspeed_video_queue_setup()
1435 sizes[0] = video->max_compressed_size; in aspeed_video_queue_setup()
1442 struct aspeed_video *video = vb2_get_drv_priv(vb->vb2_queue); in aspeed_video_buf_prepare()
1444 if (vb2_plane_size(vb, 0) < video->max_compressed_size) in aspeed_video_buf_prepare()
1445 return -EINVAL; in aspeed_video_buf_prepare()
1456 video->sequence = 0; in aspeed_video_start_streaming()
1464 set_bit(VIDEO_STREAMING, &video->flags); in aspeed_video_start_streaming()
1473 clear_bit(VIDEO_STREAMING, &video->flags); in aspeed_video_stop_streaming()
1475 rc = wait_event_timeout(video->wait, in aspeed_video_stop_streaming()
1476 !test_bit(VIDEO_FRAME_INPRG, &video->flags), in aspeed_video_stop_streaming()
1479 dev_dbg(video->dev, "Timed out when stopping streaming\n"); in aspeed_video_stop_streaming()
1499 struct aspeed_video *video = vb2_get_drv_priv(vb->vb2_queue); in aspeed_video_buf_queue()
1504 spin_lock_irqsave(&video->lock, flags); in aspeed_video_buf_queue()
1505 empty = list_empty(&video->buffers); in aspeed_video_buf_queue()
1506 list_add_tail(&avb->link, &video->buffers); in aspeed_video_buf_queue()
1507 spin_unlock_irqrestore(&video->lock, flags); in aspeed_video_buf_queue()
1509 if (test_bit(VIDEO_STREAMING, &video->flags) && in aspeed_video_buf_queue()
1510 !test_bit(VIDEO_FRAME_INPRG, &video->flags) && empty) in aspeed_video_buf_queue()
1528 struct v4l2_device *v4l2_dev = &video->v4l2_dev; in aspeed_video_setup_video()
1529 struct vb2_queue *vbq = &video->queue; in aspeed_video_setup_video()
1530 struct video_device *vdev = &video->vdev; in aspeed_video_setup_video()
1533 video->pix_fmt.pixelformat = V4L2_PIX_FMT_JPEG; in aspeed_video_setup_video()
1534 video->pix_fmt.field = V4L2_FIELD_NONE; in aspeed_video_setup_video()
1535 video->pix_fmt.colorspace = V4L2_COLORSPACE_SRGB; in aspeed_video_setup_video()
1536 video->pix_fmt.quantization = V4L2_QUANTIZATION_FULL_RANGE; in aspeed_video_setup_video()
1537 video->v4l2_input_status = V4L2_IN_ST_NO_SIGNAL; in aspeed_video_setup_video()
1539 rc = v4l2_device_register(video->dev, v4l2_dev); in aspeed_video_setup_video()
1541 dev_err(video->dev, "Failed to register v4l2 device\n"); in aspeed_video_setup_video()
1545 v4l2_ctrl_handler_init(&video->ctrl_handler, 2); in aspeed_video_setup_video()
1546 v4l2_ctrl_new_std(&video->ctrl_handler, &aspeed_video_ctrl_ops, in aspeed_video_setup_video()
1548 ASPEED_VIDEO_JPEG_NUM_QUALITIES - 1, 1, 0); in aspeed_video_setup_video()
1549 v4l2_ctrl_new_std_menu(&video->ctrl_handler, &aspeed_video_ctrl_ops, in aspeed_video_setup_video()
1554 rc = video->ctrl_handler.error; in aspeed_video_setup_video()
1556 v4l2_ctrl_handler_free(&video->ctrl_handler); in aspeed_video_setup_video()
1559 dev_err(video->dev, "Failed to init controls: %d\n", rc); in aspeed_video_setup_video()
1563 v4l2_dev->ctrl_handler = &video->ctrl_handler; in aspeed_video_setup_video()
1565 vbq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; in aspeed_video_setup_video()
1566 vbq->io_modes = VB2_MMAP | VB2_READ | VB2_DMABUF; in aspeed_video_setup_video()
1567 vbq->dev = v4l2_dev->dev; in aspeed_video_setup_video()
1568 vbq->lock = &video->video_lock; in aspeed_video_setup_video()
1569 vbq->ops = &aspeed_video_vb2_ops; in aspeed_video_setup_video()
1570 vbq->mem_ops = &vb2_dma_contig_memops; in aspeed_video_setup_video()
1571 vbq->drv_priv = video; in aspeed_video_setup_video()
1572 vbq->buf_struct_size = sizeof(struct aspeed_video_buffer); in aspeed_video_setup_video()
1573 vbq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; in aspeed_video_setup_video()
1574 vbq->min_buffers_needed = 3; in aspeed_video_setup_video()
1578 v4l2_ctrl_handler_free(&video->ctrl_handler); in aspeed_video_setup_video()
1581 dev_err(video->dev, "Failed to init vb2 queue\n"); in aspeed_video_setup_video()
1585 vdev->queue = vbq; in aspeed_video_setup_video()
1586 vdev->fops = &aspeed_video_v4l2_fops; in aspeed_video_setup_video()
1587 vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | in aspeed_video_setup_video()
1589 vdev->v4l2_dev = v4l2_dev; in aspeed_video_setup_video()
1590 strscpy(vdev->name, DEVICE_NAME, sizeof(vdev->name)); in aspeed_video_setup_video()
1591 vdev->vfl_type = VFL_TYPE_VIDEO; in aspeed_video_setup_video()
1592 vdev->vfl_dir = VFL_DIR_RX; in aspeed_video_setup_video()
1593 vdev->release = video_device_release_empty; in aspeed_video_setup_video()
1594 vdev->ioctl_ops = &aspeed_video_ioctl_ops; in aspeed_video_setup_video()
1595 vdev->lock = &video->video_lock; in aspeed_video_setup_video()
1600 v4l2_ctrl_handler_free(&video->ctrl_handler); in aspeed_video_setup_video()
1603 dev_err(video->dev, "Failed to register video device\n"); in aspeed_video_setup_video()
1614 struct device *dev = video->dev; in aspeed_video_init()
1616 irq = irq_of_parse_and_map(dev->of_node, 0); in aspeed_video_init()
1619 return -ENODEV; in aspeed_video_init()
1629 video->eclk = devm_clk_get(dev, "eclk"); in aspeed_video_init()
1630 if (IS_ERR(video->eclk)) { in aspeed_video_init()
1632 return PTR_ERR(video->eclk); in aspeed_video_init()
1635 rc = clk_prepare(video->eclk); in aspeed_video_init()
1639 video->vclk = devm_clk_get(dev, "vclk"); in aspeed_video_init()
1640 if (IS_ERR(video->vclk)) { in aspeed_video_init()
1642 rc = PTR_ERR(video->vclk); in aspeed_video_init()
1646 rc = clk_prepare(video->vclk); in aspeed_video_init()
1658 if (!aspeed_video_alloc_buf(video, &video->jpeg, in aspeed_video_init()
1661 rc = -ENOMEM; in aspeed_video_init()
1665 aspeed_video_init_jpeg_table(video->jpeg.virt, video->yuv420); in aspeed_video_init()
1671 clk_unprepare(video->vclk); in aspeed_video_init()
1673 clk_unprepare(video->eclk); in aspeed_video_init()
1679 { .compatible = "aspeed,ast2400-video-engine", .data = &ast2400_config },
1680 { .compatible = "aspeed,ast2500-video-engine", .data = &ast2500_config },
1681 { .compatible = "aspeed,ast2600-video-engine", .data = &ast2600_config },
1693 video = devm_kzalloc(&pdev->dev, sizeof(*video), GFP_KERNEL); in aspeed_video_probe()
1695 return -ENOMEM; in aspeed_video_probe()
1697 video->base = devm_platform_ioremap_resource(pdev, 0); in aspeed_video_probe()
1698 if (IS_ERR(video->base)) in aspeed_video_probe()
1699 return PTR_ERR(video->base); in aspeed_video_probe()
1701 match = of_match_node(aspeed_video_of_match, pdev->dev.of_node); in aspeed_video_probe()
1703 return -EINVAL; in aspeed_video_probe()
1705 config = match->data; in aspeed_video_probe()
1706 video->jpeg_mode = config->jpeg_mode; in aspeed_video_probe()
1707 video->comp_size_read = config->comp_size_read; in aspeed_video_probe()
1709 video->frame_rate = 30; in aspeed_video_probe()
1710 video->dev = &pdev->dev; in aspeed_video_probe()
1711 spin_lock_init(&video->lock); in aspeed_video_probe()
1712 mutex_init(&video->video_lock); in aspeed_video_probe()
1713 init_waitqueue_head(&video->wait); in aspeed_video_probe()
1714 INIT_DELAYED_WORK(&video->res_work, aspeed_video_resolution_work); in aspeed_video_probe()
1715 INIT_LIST_HEAD(&video->buffers); in aspeed_video_probe()
1723 clk_unprepare(video->vclk); in aspeed_video_probe()
1724 clk_unprepare(video->eclk); in aspeed_video_probe()
1733 struct device *dev = &pdev->dev; in aspeed_video_remove()
1739 clk_unprepare(video->vclk); in aspeed_video_remove()
1740 clk_unprepare(video->eclk); in aspeed_video_remove()
1742 vb2_video_unregister_device(&video->vdev); in aspeed_video_remove()
1744 v4l2_ctrl_handler_free(&video->ctrl_handler); in aspeed_video_remove()
1748 dma_free_coherent(video->dev, VE_JPEG_HEADER_SIZE, video->jpeg.virt, in aspeed_video_remove()
1749 video->jpeg.dma); in aspeed_video_remove()