/*
 ******************************************************************************
 *
 * stats.c
 *
 * Hawkview ISP - stats.c module
 *
 * Copyright (c) 2016 by Allwinnertech Co., Ltd.  http://www.allwinnertech.com
 *
 * Version		  Author         Date		    Description
 *
 *   3.0		  Yang Feng   	2016/03/17	VIDEO INPUT
 *
 *****************************************************************************
 */

#include <sys/ioctl.h>
#include <sys/time.h>

#include <linux/videodev2.h>

#include <errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "../include/device/isp_dev.h"
#include "isp_dev_priv.h"
#include "isp_stats.h"
#include "isp_v4l2_helper.h"
#include "tools.h"

#define ENTITY_SUNXI_H3A		"sunxi_h3a"

static void isp_stats_process(struct hw_isp_device *isp,
			void *buffer, size_t size __attribute__((__unused__)))
{

	if(isp->ops->stats_ready)
		isp->ops->stats_ready(isp, buffer);
	else
		ISP_DEV_LOG(ISP_LOG_STAT, "Stats: stats_ready is NULL.\n");
}

static void isp_stats_event(void *priv)
{
	struct hw_isp_device *isp = priv;
	struct isp_stats *stats_sd = &isp->stats_sd;
	struct vin_isp_stat_data data;
	struct v4l2_event event;
	struct vin_isp_stat_event_status *status = (struct vin_isp_stat_event_status *)event.u.data;
	int ret;

	memset(&event, 0, sizeof event);
	ret = ioctl(stats_sd->entity.fd, VIDIOC_DQEVENT, &event);
	if (ret < 0) {
		ISP_ERR("unable to retrieve AEWB event: %s (%d).\n",
			strerror(errno), errno);
		return;
	}

	if (status->buf_err) {
		ISP_ERR("AEWB: stats error, skipping buffer.\n");
		return;
	}

	memset(&data, 0, sizeof data);
	data.buf = stats_sd->buffer;
	data.buf_size = stats_sd->size;

	ret = ioctl(stats_sd->entity.fd, VIDIOC_VIN_ISP_STAT_REQ, &data);
	if (ret < 0) {
		ISP_ERR("unable to retrieve AEWB data: %s (%d).\n",
			strerror(errno), errno);
		return;
	}

	isp_stats_process(isp, data.buf, data.buf_size);
}

static int isp_stats_setup(struct hw_isp_device *isp)
{
	struct isp_stats *stats_sd = &isp->stats_sd;
	struct vin_isp_h3a_config config;
	int ret;

	config.buf_size = ISP_STAT_TOTAL_SIZE;
	ret = ioctl(stats_sd->entity.fd, VIDIOC_VIN_ISP_H3A_CFG, &config);
	if (ret < 0)
		return -errno;

	stats_sd->size = config.buf_size;
	stats_sd->buffer = malloc(config.buf_size);
	if (stats_sd->buffer == NULL)
		return -ENOMEM;

	return 0;
}

/* -----------------------------------------------------------------------------
 * Start/stop, init/cleanup
 */
void isp_stats_enable(struct hw_isp_device *isp, bool enable)
{
	struct isp_stats *stats_sd = &isp->stats_sd;

	stats_sd->enabled = enable;
}

int isp_stats_start(struct hw_isp_device *isp)
{
	struct isp_stats *stats_sd = &isp->stats_sd;
	struct v4l2_event_subscription esub;
	unsigned int enable = 1;
	int ret;

	if (!stats_sd->enabled)
		return 0;

	ret = isp_stats_setup(isp);
	if (ret < 0) {
		ISP_ERR("unable to configure AEWB engine: %s (%d).\n",
			strerror(errno), errno);
		return ret;
	}

	memset(&esub, 0, sizeof(struct v4l2_event_subscription));
	esub.id = 0;
	esub.type = V4L2_EVENT_VIN_H3A;
	ret = ioctl(stats_sd->entity.fd, VIDIOC_SUBSCRIBE_EVENT, &esub);
	if (ret < 0) {
		ISP_ERR("unable to subscribe to AEWB event: %s (%d).\n",
			strerror(errno), errno);
		return ret;
	}
	ret = ioctl(stats_sd->entity.fd, VIDIOC_VIN_ISP_STAT_EN, &enable);
	if (ret < 0) {
		ISP_ERR("unable to start AEWB engine: %s (%d).\n",
			strerror(errno), errno);
		return ret;
	}

	isp->ops->monitor_fd(isp->id, stats_sd->entity.fd, HW_ISP_EVENT_EXCEPTION,
			   isp_stats_event, isp);

	return 0;
}

void isp_stats_stop(struct hw_isp_device *isp)
{
	struct isp_stats *stats_sd = &isp->stats_sd;
	struct v4l2_event_subscription esub;
	unsigned int enable = 0;

	if (!stats_sd->enabled)
		return;

	isp->ops->unmonitor_fd(isp->id, stats_sd->entity.fd);
	ioctl(stats_sd->entity.fd, VIDIOC_VIN_ISP_STAT_EN, &enable);

	memset(&esub, 0, sizeof esub);
	esub.type = V4L2_EVENT_VIN_H3A;
	ioctl(stats_sd->entity.fd, VIDIOC_UNSUBSCRIBE_EVENT, &esub);

	if (stats_sd->buffer != NULL) {
		free(stats_sd->buffer);
		stats_sd->buffer = NULL;
	}
}

int isp_stats_init(struct hw_isp_device *isp)
{
	struct media_entity *entity = NULL;
	struct hw_isp_media_dev *media = hw_isp_get_priv_data(isp);
	char name[32];

	snprintf(name, sizeof(name), ENTITY_SUNXI_H3A".%u", isp->id);
	ISP_DEV_LOG(ISP_LOG_STAT, "stats device name is %s\n", name);
	entity = media_get_entity_by_name(media->mdev, name);
	if (entity == NULL)
		return -ENOENT;

	isp->stats_sd.entity = *entity;

	return v4l2_subdev_open(&isp->stats_sd.entity);
}

void isp_stats_exit(struct hw_isp_device *isp)
{
	v4l2_subdev_close(&isp->stats_sd.entity);
}