You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
hardware_samsung/exynos4/hal/libhwjpeg/jpeg_hal_unit.c

573 lines
13 KiB

/*
* Copyright@ Samsung Electronics Co. LTD
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
12 years ago
#define LOG_TAG "libhwjpeg"
#include <stdio.h>
#include <stdlib.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <ctype.h>
#include <unistd.h>
#include <sys/mman.h>
#include <string.h>
#include <errno.h>
#include <signal.h>
#include <math.h>
#include <sys/poll.h>
#include <cutils/log.h>
#include "jpeg_hal.h"
#ifdef JPEG_PERF_MEAS
unsigned long measure_time(struct timeval *start, struct timeval *stop)
{
unsigned long sec, usec, time;
sec = stop->tv_sec - start->tv_sec;
if (stop->tv_usec >= start->tv_usec) {
usec = stop->tv_usec - start->tv_usec;
} else {
usec = stop->tv_usec + 1000000 - start->tv_usec;
sec--;
}
time = (sec * 1000000) + usec;
return time;
}
#endif
static int jpeg_v4l2_querycap(int fd)
{
struct v4l2_capability cap;
int ret = 0;
ret = ioctl(fd, VIDIOC_QUERYCAP, &cap);
if (!(cap.capabilities & V4L2_CAP_STREAMING))
ALOGE("[%s]: does not support streaming", __func__);
if (!(cap.capabilities & V4L2_CAP_VIDEO_OUTPUT))
ALOGE("[%s]: does not support output", __func__);
if (!(cap.capabilities & V4L2_CAP_VIDEO_CAPTURE))
ALOGE("[%s]: does not support capture", __func__);
return ret;
}
static int jpeg_v4l2_s_jpegcomp(int fd, int quality)
{
struct v4l2_jpegcompression arg;
int ret = 0;
arg.quality = quality;
ret = ioctl(fd, VIDIOC_S_JPEGCOMP, &arg);
return ret;
}
static int jpeg_v4l2_s_fmt(int fd, enum v4l2_buf_type type, struct jpeg_config *config)
{
struct v4l2_format fmt;
int ret = 0;
fmt.type = type;
fmt.fmt.pix_mp.width = config->width;
fmt.fmt.pix_mp.height = config->height;
fmt.fmt.pix_mp.field = V4L2_FIELD_ANY;
fmt.fmt.pix_mp.num_planes = config->num_planes;
if (config->mode == JPEG_ENCODE)
fmt.fmt.pix_mp.colorspace = V4L2_COLORSPACE_JPEG;
switch (fmt.type) {
case V4L2_BUF_TYPE_VIDEO_OUTPUT: /* fall through */
case V4L2_BUF_TYPE_VIDEO_CAPTURE:
break;
case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE:
if (config->mode == JPEG_ENCODE) {
fmt.fmt.pix_mp.pixelformat = config->pix.enc_fmt.in_fmt;
} else {
fmt.fmt.pix_mp.pixelformat = config->pix.dec_fmt.in_fmt;
fmt.fmt.pix_mp.plane_fmt[0].sizeimage = config->sizeJpeg;
}
break;
case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE:
if (config->mode == JPEG_ENCODE) {
fmt.fmt.pix_mp.pixelformat = config->pix.enc_fmt.out_fmt;
} else {
fmt.fmt.pix_mp.pixelformat = config->pix.dec_fmt.out_fmt;
fmt.fmt.pix_mp.width = config->scaled_width;
fmt.fmt.pix_mp.height = config->scaled_height;
}
break;
default:
ALOGE("[%s]: invalid v4l2 buf type", __func__);
return -1;
}
ret = ioctl(fd, VIDIOC_S_FMT, &fmt);
return ret;
}
static int jpeg_v4l2_g_fmt(int fd, enum v4l2_buf_type type, struct jpeg_config *config)
{
struct v4l2_format fmt;
int ret = 0;
fmt.type = type;
ret = ioctl(fd, VIDIOC_G_FMT, &fmt);
if (ret < 0)
return -1;
config->width = fmt.fmt.pix_mp.width;
config->height = fmt.fmt.pix_mp.height;
switch (fmt.type) {
case V4L2_BUF_TYPE_VIDEO_OUTPUT: /* fall through */
case V4L2_BUF_TYPE_VIDEO_CAPTURE:
break;
case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE:
if (config->mode == JPEG_ENCODE)
config->pix.enc_fmt.in_fmt = fmt.fmt.pix_mp.pixelformat;
else
config->pix.dec_fmt.in_fmt = fmt.fmt.pix_mp.pixelformat;
break;
case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE:
if (config->mode == JPEG_ENCODE)
config->pix.enc_fmt.out_fmt = fmt.fmt.pix_mp.pixelformat;
else
config->pix.dec_fmt.out_fmt = fmt.fmt.pix_mp.pixelformat;
break;
default:
ALOGE("[%s]: invalid v4l2 buf type", __func__);
return -1;
}
return ret;
}
int jpeghal_getconfig(int fd, struct jpeg_config *config)
{
int ret = 0;
ret = jpeg_v4l2_g_fmt(fd, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE, config);
if (ret < 0) {
ALOGE("[%s]: input G_FMT failed", __func__);
return -1;
}
ret = jpeg_v4l2_g_fmt(fd, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE, config);
if (ret < 0)
ALOGE("[%s]: output G_FMT failed", __func__);
return ret;
}
static int jpeg_v4l2_reqbufs(int fd, int buf_cnt, struct jpeg_buf *buf)
{
struct v4l2_requestbuffers req;
int ret = 0;
memset(&req, 0, sizeof(req));
req.type = buf->buf_type;
req.memory = buf->memory;
req.count = buf_cnt;
ret = ioctl(fd, VIDIOC_REQBUFS, &req);
return ret;
}
static int jpeg_v4l2_querybuf(int fd, struct jpeg_buf *buf)
{
struct v4l2_buffer v4l2_buf;
struct v4l2_plane plane[JPEG_MAX_PLANE_CNT];
int i;
int ret = 0;
memset(plane, 0, (int)JPEG_MAX_PLANE_CNT * sizeof(struct v4l2_plane));
v4l2_buf.index = 0;
v4l2_buf.type = buf->buf_type;
v4l2_buf.memory = buf->memory;
v4l2_buf.length = buf->num_planes;
v4l2_buf.m.planes = plane;
ret = ioctl(fd, VIDIOC_QUERYBUF, &v4l2_buf);
if (ret < 0) {
ALOGE("[%s:%d]: VIDIOC_QUERYBUF failed", __func__, ret);
return ret;
}
for (i= 0; i < buf->num_planes; i++) {
buf->length[i] = v4l2_buf.m.planes[i].length;
buf->start[i] = (char *) mmap(0, buf->length[i],
PROT_READ | PROT_WRITE, MAP_SHARED, fd,
v4l2_buf.m.planes[i].m.mem_offset);
//ALOGI("[%s]: buf.start[%d] = %p, length = %d", __func__, 0, buf->start[0], buf->length[0]);
if (buf->start[0] == MAP_FAILED) {
ALOGE("[%s]: mmap failed", __func__);
return -1;
}
}
return ret;
}
static int jpeg_v4l2_qbuf(int fd, struct jpeg_buf *buf)
{
struct v4l2_buffer v4l2_buf;
struct v4l2_plane plane[JPEG_MAX_PLANE_CNT];
int i;
int ret = 0;
memset(&v4l2_buf, 0, sizeof(struct v4l2_buffer));
memset(plane, 0, (int)JPEG_MAX_PLANE_CNT * sizeof(struct v4l2_plane));
v4l2_buf.index = 0;
v4l2_buf.type = buf->buf_type;
v4l2_buf.memory = buf->memory;
v4l2_buf.length = buf->num_planes;
v4l2_buf.m.planes = plane;
if (buf->memory == V4L2_MEMORY_USERPTR) {
for (i = 0; i < buf->num_planes; i++) {
v4l2_buf.m.planes[i].m.userptr = (unsigned long)buf->start[i];
v4l2_buf.m.planes[i].length = buf->length[i];
}
}
ret = ioctl(fd, VIDIOC_QBUF, &v4l2_buf);
if (ret < 0) {
ALOGE("[%s:%d] QBUF failed", __func__, ret);
return -1;
}
return ret;
}
static int jpeg_v4l2_dqbuf(int fd, enum v4l2_buf_type type, enum v4l2_memory memory)
{
struct v4l2_buffer buf;
int ret = 0;
memset(&buf, 0, sizeof(struct v4l2_buffer));
buf.type = type;
buf.memory = memory;
ret = ioctl(fd, VIDIOC_DQBUF, &buf);
if (ret < 0) {
ALOGE("[%s:%d] DQBUF failed", __func__, ret);
return -1;
}
return ret;
}
static int jpeg_v4l2_streamon(int fd, enum v4l2_buf_type type)
{
int ret = 0;
ret = ioctl(fd, VIDIOC_STREAMON, &type);
if (ret < 0) {
ALOGE("[%s:%d] STREAMON failed", __func__, ret);
return -1;
}
return ret;
}
static int jpeg_v4l2_streamoff(int fd, enum v4l2_buf_type type)
{
int ret = 0;
ret = ioctl(fd, VIDIOC_STREAMOFF, &type);
if (ret < 0) {
ALOGE("[%s:%d] STREAMOFF failed", __func__, ret);
return -1;
}
return ret;
}
int jpeghal_dec_init()
{
int fd;
int ret = 0;
fd = open(JPEG_DEC_NODE, O_RDWR, 0);
if (fd < 0) {
ALOGE("[%s]: JPEG dec open failed", __func__);
return -1;
}
ret = jpeg_v4l2_querycap(fd);
if (ret < 0) {
ALOGE("[%s]: QUERYCAP failed", __func__);
return -1;
}
return fd;
}
int jpeghal_enc_init()
{
int fd;
int ret = 0;
fd = open(JPEG_ENC_NODE, O_RDWR, 0);
if (fd < 0) {
ALOGE("[%s]: JPEG enc open failed", __func__);
return -1;
}
ret = jpeg_v4l2_querycap(fd);
if (ret < 0) {
ALOGE("[%s]: QUERYCAP failed", __func__);
return -1;
}
return fd;
}
int jpeghal_dec_setconfig(int fd, struct jpeg_config *config)
{
int ret = 0;
config->mode = JPEG_DECODE;
ret = jpeg_v4l2_s_fmt(fd, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE, config);
if (ret < 0) {
ALOGE("[%s]: decoder input S_FMT failed", __func__);
return -1;
}
ret = jpeg_v4l2_s_fmt(fd, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE, config);
if (ret < 0) {
ALOGE("[%s]: decoder output S_FMT failed", __func__);
return -1;
}
return ret;
}
int jpeghal_dec_getconfig(int fd, struct jpeg_config *config)
{
int ret = 0;
jpeghal_getconfig(fd, config);
return ret;
}
int jpeghal_enc_setconfig(int fd, struct jpeg_config *config)
{
int ret = 0;
ret = jpeg_v4l2_s_jpegcomp(fd, config->enc_qual);
if (ret < 0) {
ALOGE("[%s]: S_JPEGCOMP failed", __func__);
return -1;
}
config->mode = JPEG_ENCODE;
ret = jpeg_v4l2_s_fmt(fd, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE, config);
if (ret < 0) {
ALOGE("[%s]: encoder input S_FMT failed", __func__);
return -1;
}
ret = jpeg_v4l2_s_fmt(fd, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE, config);
if (ret < 0) {
ALOGE("[%s]: encoder output S_FMT failed", __func__);
return -1;
}
return ret;
}
int jpeghal_enc_getconfig(int fd, struct jpeg_config *config)
{
int ret = 0;
jpeghal_getconfig(fd, config);
return ret;
}
int jpeghal_set_inbuf(int fd, struct jpeg_buf *buf)
{
int ret = 0;
buf->buf_type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
ret = jpeg_v4l2_reqbufs(fd, 1, buf);
if (ret < 0) {
ALOGE("[%s:%d]: Input REQBUFS failed", __func__, ret);
return -1;
}
if (buf->memory == V4L2_MEMORY_MMAP) {
ret = jpeg_v4l2_querybuf(fd, buf);
if (ret < 0) {
ALOGE("[%s:%d]: Input QUERYBUF failed", __func__, ret);
return -1;
}
}
return ret;
}
int jpeghal_set_outbuf(int fd, struct jpeg_buf *buf)
{
int ret = 0;
buf->buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
ret = jpeg_v4l2_reqbufs(fd, 1, buf);
if (ret < 0) {
ALOGE("[%s:%d]: Output REQBUFS failed", __func__, ret);
return -1;
}
if (buf->memory == V4L2_MEMORY_MMAP) {
ret = jpeg_v4l2_querybuf(fd, buf);
if (ret < 0) {
ALOGE("[%s:%d]: Output QUERYBUF failed", __func__, ret);
return -1;
}
}
return ret;
}
static int jpeg_exe(int fd, struct jpeg_buf *in_buf, struct jpeg_buf *out_buf)
{
int ret = 0;
ret = jpeg_v4l2_qbuf(fd, in_buf);
if (ret < 0) {
ALOGE("[%s:%d]: Input QBUF failed", __func__, ret);
return -1;
}
ret = jpeg_v4l2_qbuf(fd, out_buf);
if (ret < 0) {
ALOGE("[%s:%d]: Output QBUF failed", __func__, ret);
return -1;
}
ret = jpeg_v4l2_streamon(fd, in_buf->buf_type);
ret = jpeg_v4l2_streamon(fd, out_buf->buf_type);
ret = jpeg_v4l2_dqbuf(fd, in_buf->buf_type, in_buf->memory);
ret = jpeg_v4l2_dqbuf(fd, out_buf->buf_type, out_buf->memory);
return ret;
}
int jpeghal_dec_exe(int fd, struct jpeg_buf *in_buf, struct jpeg_buf *out_buf)
{
int ret = 0;
ret = jpeg_exe(fd, in_buf, out_buf);
if (ret < 0)
ALOGE("[%s]: JPEG decoding is failed", __func__);
return ret;
}
int jpeghal_enc_exe(int fd, struct jpeg_buf *in_buf, struct jpeg_buf *out_buf)
{
int ret = 0;
ret = jpeg_exe(fd, in_buf, out_buf);
if (ret < 0)
ALOGE("[%s]: JPEG Encoding is failed", __func__);
return ret;
}
int jpeghal_deinit(int fd, struct jpeg_buf *in_buf, struct jpeg_buf *out_buf)
{
int ret = 0;
jpeg_v4l2_streamoff(fd, in_buf->buf_type);
jpeg_v4l2_streamoff(fd, out_buf->buf_type);
if (in_buf->memory == V4L2_MEMORY_MMAP)
munmap((char *)(in_buf->start[0]), in_buf->length[0]);
if (out_buf->memory == V4L2_MEMORY_MMAP)
munmap((char *)(out_buf->start[0]), out_buf->length[0]);
jpeg_v4l2_reqbufs(fd, 0, in_buf);
jpeg_v4l2_reqbufs(fd, 0, out_buf);
ret = close(fd);
return ret;
}
int jpeghal_s_ctrl(int fd, int cid, int value)
{
struct v4l2_control vc;
int ret = 0;
vc.id = cid;
vc.value = value;
ret = ioctl(fd, VIDIOC_S_CTRL, &vc);
if (ret != 0) {
ALOGE("[%s] ioctl : cid(%d), value(%d)\n", __func__, cid, value);
return -1;
}
return ret;
}
int jpeghal_g_ctrl(int fd, int id)
{
struct v4l2_control ctrl;
int ret = 0;
ctrl.id = id;
ret = ioctl(fd, VIDIOC_G_CTRL, &ctrl);
if (ret < 0) {
ALOGE("[%s] ioctl : cid(%d)\n", __func__, ctrl.id);
return -1;
}
return ctrl.value;
}