#include "V4l2Isp10Ioctl.h"
#include <sys/ioctl.h>
//#include <error.h>


using namespace std;

#define GET_ISP_CFG(ID,VAL) \
  int ret = ioctl(mDevFp, ID, &(VAL)); \
  if (ret < 0) { \
    return false; \
  } \
  return true;

#define SET_ISP_CFG(ID,VAL,ID1, ENABLE) \
  if(ENABLE) { \
    int ret = ioctl(mDevFp, ID, &(VAL)); \
    if (ret < 0) { \
      return false; \
    } \
  } else { \
  } \
  return setControl(ID1, ENABLE);


V4l2Isp10Ioctl::V4l2Isp10Ioctl(int devFp):
  mDevFp(devFp) {
}
V4l2Isp10Ioctl::~V4l2Isp10Ioctl(void) {
}
/* dpcc */
bool V4l2Isp10Ioctl::getDpccCfg(struct cifisp_dpcc_config& dpccCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_DPCC, dpccCfg);
}
bool V4l2Isp10Ioctl::setDpccCfg(struct cifisp_dpcc_config& dpccCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_DPCC, dpccCfg,
              V4L2_CID_CIFISP_DPCC, enable);
}

/* bls */
bool V4l2Isp10Ioctl::getBlsCfg(struct cifisp_bls_config& blsCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_BLS, blsCfg);

}
bool V4l2Isp10Ioctl::setBlsCfg(struct cifisp_bls_config& blsCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_BLS, blsCfg,
              V4L2_CID_CIFISP_BLS, enable);
}
/* degamma */
bool V4l2Isp10Ioctl::getSdgCfg(struct cifisp_sdg_config& sdgCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_SDG, sdgCfg);
}
bool V4l2Isp10Ioctl::setSdgCfg(struct cifisp_sdg_config& sdgCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_SDG, sdgCfg,
              V4L2_CID_CIFISP_SDG, enable);
}
/* lsc */
bool V4l2Isp10Ioctl::getLscCfg(struct cifisp_lsc_config& lscCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_LSC, lscCfg);
}
bool V4l2Isp10Ioctl::setLscCfg(struct cifisp_lsc_config& lscCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_LSC, lscCfg,
              V4L2_CID_CIFISP_LSC, enable);
}
/* awb measure */
bool V4l2Isp10Ioctl::getAwbMeasCfg(struct cifisp_awb_meas_config& awbCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_AWB_MEAS, awbCfg);
}
bool V4l2Isp10Ioctl::setAwbMeasCfg(struct cifisp_awb_meas_config& awbCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_AWB_MEAS, awbCfg,
              V4L2_CID_CIFISP_AWB_MEAS, enable);
}
/* filter */
bool V4l2Isp10Ioctl::getFltCfg(struct cifisp_flt_config& fltCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_FLT, fltCfg);
}
bool V4l2Isp10Ioctl::setFltCfg(struct cifisp_flt_config& fltCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_FLT, fltCfg,
              V4L2_CID_CIFISP_FLT, enable);
}
/* demosaic */
bool V4l2Isp10Ioctl::getBdmCfg(struct cifisp_bdm_config& bdmCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_BDM, bdmCfg);
}
bool V4l2Isp10Ioctl::setBdmCfg(struct cifisp_bdm_config& bdmCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_BDM, bdmCfg,
              V4L2_CID_CIFISP_BDM, enable);
}
/* cross talk */
bool V4l2Isp10Ioctl::getCtkCfg(struct cifisp_ctk_config& ctkCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_CTK, ctkCfg);
}
bool V4l2Isp10Ioctl::setCtkCfg(struct cifisp_ctk_config& ctkCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_CTK, ctkCfg,
              V4L2_CID_CIFISP_CTK, enable);
}
/* gamma out */
bool V4l2Isp10Ioctl::getGocCfg(struct cifisp_goc_config& gocCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_GOC, gocCfg);
}
bool V4l2Isp10Ioctl::setGocCfg(struct cifisp_goc_config& gocCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_GOC, gocCfg,
              V4L2_CID_CIFISP_GOC, enable);
}
/* Histogram Measurement */
bool V4l2Isp10Ioctl::getHstCfg(struct cifisp_hst_config& hstCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_HST, hstCfg);
}
bool V4l2Isp10Ioctl::setHstCfg(struct cifisp_hst_config& hstCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_HST, hstCfg,
              V4L2_CID_CIFISP_HST, enable);
}
/* Auto Exposure Measurements */
bool V4l2Isp10Ioctl::getAecCfg(struct cifisp_aec_config& aecCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_AEC, aecCfg);
}
bool V4l2Isp10Ioctl::setAecCfg(struct cifisp_aec_config& aecCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_AEC, aecCfg,
              V4L2_CID_CIFISP_AEC, enable);
}
/* awb gain */
bool V4l2Isp10Ioctl::getAwbGainCfg(struct cifisp_awb_gain_config& awbgCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_AWB_GAIN, awbgCfg);
}
bool V4l2Isp10Ioctl::setAwbGainCfg(struct cifisp_awb_gain_config& awbgCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_AWB_GAIN, awbgCfg,
              V4L2_CID_CIFISP_AWB_GAIN, enable);
}
/* color process */
bool V4l2Isp10Ioctl::getCprocCfg(struct cifisp_cproc_config& cprocCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_CPROC, cprocCfg);
}
bool V4l2Isp10Ioctl::setCprocCfg(struct cifisp_cproc_config& cprocCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_CPROC, cprocCfg,
              V4L2_CID_CIFISP_CPROC, enable);
}
/* afc */
bool V4l2Isp10Ioctl::getAfcCfg(struct cifisp_afc_config& afcCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_AFC, afcCfg);
}
bool V4l2Isp10Ioctl::setAfcCfg(struct cifisp_afc_config& afcCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_AFC, afcCfg,
              V4L2_CID_CIFISP_AFC, enable);
}
/* ie */
bool V4l2Isp10Ioctl::getIeCfg(struct cifisp_ie_config& ieCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_IE, ieCfg);
}
bool V4l2Isp10Ioctl::setIeCfg(struct cifisp_ie_config& ieCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_IE, ieCfg,
              V4L2_CID_CIFISP_IE, enable);
}
/* dpf */
bool V4l2Isp10Ioctl::getDpfCfg(struct cifisp_dpf_config& dpfCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_DPF, dpfCfg);
}
bool V4l2Isp10Ioctl::setDpfCfg(struct cifisp_dpf_config& dpfCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_DPF, dpfCfg,
              V4L2_CID_CIFISP_DPF, enable);
}
bool V4l2Isp10Ioctl::getDpfStrengthCfg(struct cifisp_dpf_strength_config& dpfStrCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_DPF_STRENGTH, dpfStrCfg);
}
bool V4l2Isp10Ioctl::setDpfStrengthCfg(struct cifisp_dpf_strength_config& dpfStrCfg, bool enable) {
  SET_ISP_CFG(CIFISP_IOC_S_DPF_STRENGTH, dpfStrCfg,
              V4L2_CID_CIFISP_DPF, enable);
}
/* last capture config */
bool V4l2Isp10Ioctl::getLastCapCfg(struct cifisp_last_capture_config& lastCapCfg) {
  GET_ISP_CFG(CIFISP_IOC_G_LAST_CONFIG, lastCapCfg);
}
/* get statistics */
bool V4l2Isp10Ioctl::getAwbStat(struct cifisp_awb_stat& awbStat) {
  UNUSED_PARAM(awbStat);
  //TODO
  return false;
}
bool V4l2Isp10Ioctl::getAeStat(struct cifisp_ae_stat& aeStat) {
  UNUSED_PARAM(aeStat);
  //TODO
  return false;
}
bool V4l2Isp10Ioctl::getAfStat(struct cifisp_af_stat& afStat) {
  UNUSED_PARAM(afStat);
  //TODO
  return false;
}

bool V4l2Isp10Ioctl::setControl(int id, bool enable) {
  struct v4l2_control ctrl;

  ctrl.id = id;

  if (enable)
    ctrl.value = 1;
  else
    ctrl.value = 0;

  int ret = ioctl(mDevFp, VIDIOC_S_CTRL, &ctrl);

  if (ret < 0) {
    //LOGE("ERR(%s):VIDIOC_S_CTRL(id = %#x (%d), value = %d) failed ret = %d\n",
    //    __func__, ctrl.id, ctrl.id-V4L2_CID_PRIVATE_BASE, ctrl.value, ret);

  }

  return ret < 0 ? false : true;
}