1 /* 2 * atomisp_device.cpp - atomisp device 3 * 4 * Copyright (c) 2014-2015 Intel Corporation 5 * 6 * Licensed under the Apache License, Version 2.0 (the "License"); 7 * you may not use this file except in compliance with the License. 8 * You may obtain a copy of the License at 9 * 10 * http://www.apache.org/licenses/LICENSE-2.0 11 * 12 * Unless required by applicable law or agreed to in writing, software 13 * distributed under the License is distributed on an "AS IS" BASIS, 14 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 15 * See the License for the specific language governing permissions and 16 * limitations under the License. 17 * 18 * Author: Wind Yuan <feng.yuan (at) intel.com> 19 */ 20 21 #include "atomisp_device.h" 22 #include "v4l2_buffer_proxy.h" 23 #include <linux/v4l2-subdev.h> 24 25 namespace XCam { 26 27 AtomispDevice::AtomispDevice (const char *name) 28 : V4l2Device (name) 29 { 30 } 31 32 AtomispDevice::~AtomispDevice () 33 { 34 } 35 36 XCamReturn 37 AtomispDevice::pre_set_format (struct v4l2_format &format) 38 { 39 uint32_t fps_n = 0, fps_d = 0; 40 struct v4l2_subdev_format subdev_fmt; 41 42 // set framerate by subdev 43 this->get_framerate (fps_n, fps_d); 44 if (fps_n != 0 && fps_d != 0) { 45 struct v4l2_subdev_frame_interval frame_intvl; 46 xcam_mem_clear (frame_intvl); 47 if (io_control (VIDIOC_SUBDEV_G_FRAME_INTERVAL, &frame_intvl) < 0) { 48 XCAM_LOG_WARNING ("atomisp device(%s) get framerate failed ", XCAM_STR (get_device_name())); 49 } else { 50 frame_intvl.interval.denominator = fps_n; 51 frame_intvl.interval.numerator = fps_d; 52 if (io_control (VIDIOC_SUBDEV_S_FRAME_INTERVAL, &frame_intvl) < 0) { 53 XCAM_LOG_WARNING ("atomisp device(%s) set framerate failed", XCAM_STR (get_device_name())); 54 } 55 } 56 } 57 58 // negotiate and set sensor output format by subdev 59 xcam_mem_clear (subdev_fmt); 60 subdev_fmt.pad = 0; 61 subdev_fmt.which = V4L2_SUBDEV_FORMAT_TRY; 62 subdev_fmt.format.width = format.fmt.pix.width; 63 subdev_fmt.format.height = format.fmt.pix.height; 64 subdev_fmt.format.field = V4L2_FIELD_NONE; 65 if (format.fmt.pix.pixelformat == V4L2_PIX_FMT_SGRBG12) { 66 subdev_fmt.format.code = V4L2_MBUS_FMT_SRGGB12_1X12; 67 } else { 68 subdev_fmt.format.code = V4L2_MBUS_FMT_SRGGB10_1X10; 69 } 70 71 if (io_control(VIDIOC_SUBDEV_S_FMT, &subdev_fmt) < 0) { 72 XCAM_LOG_ERROR ("atomisp device(%s) try subdev format failed", XCAM_STR (get_device_name())); 73 return XCAM_RETURN_ERROR_IOCTL; 74 } 75 XCAM_LOG_INFO ("target subdev format (%dx%d, code %d)", 76 subdev_fmt.format.width, 77 subdev_fmt.format.height, 78 subdev_fmt.format.code); 79 80 subdev_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; 81 if (io_control (VIDIOC_SUBDEV_G_FMT, &subdev_fmt) < 0) { 82 XCAM_LOG_ERROR ("atomisp device(%s) get subdev format failed", XCAM_STR (get_device_name())); 83 } 84 XCAM_LOG_INFO ("negotiated subdev format (%dx%d, code %d)", 85 subdev_fmt.format.width, 86 subdev_fmt.format.height, 87 subdev_fmt.format.code); 88 89 if (io_control(VIDIOC_SUBDEV_S_FMT, &subdev_fmt) < 0) { 90 XCAM_LOG_ERROR ("atomisp device(%s) set subdev format failed", XCAM_STR (get_device_name())); 91 return XCAM_RETURN_ERROR_IOCTL; 92 } 93 94 return XCAM_RETURN_NO_ERROR; 95 } 96 97 XCamReturn 98 AtomispDevice::allocate_buffer ( 99 SmartPtr<V4l2Buffer> &buf, 100 const struct v4l2_format &format, 101 const uint32_t index) 102 { 103 #if HAVE_LIBDRM 104 if (!_drm_disp.ptr()) { 105 _drm_disp = DrmDisplay::instance (); 106 } 107 108 if (get_mem_type () == V4L2_MEMORY_DMABUF && _drm_disp.ptr () != NULL) { 109 buf = _drm_disp->create_drm_buf (format, index, get_capture_buf_type ()); 110 if (!buf.ptr()) { 111 XCAM_LOG_WARNING ("atomisp device(%s) allocate buffer failed", XCAM_STR (get_device_name())); 112 return XCAM_RETURN_ERROR_MEM; 113 } 114 return XCAM_RETURN_NO_ERROR; 115 } 116 #endif 117 118 return V4l2Device::allocate_buffer (buf, format, index); 119 } 120 121 }; 122
