// SPDX-License-Identifier: GPL-2.0
|
/*
|
* Support for Medifield PNW Camera Imaging ISP subsystem.
|
*
|
* Copyright (c) 2010 Intel Corporation. All Rights Reserved.
|
*
|
* Copyright (c) 2010 Silicon Hive www.siliconhive.com.
|
*
|
* This program is free software; you can redistribute it and/or
|
* modify it under the terms of the GNU General Public License version
|
* 2 as published by the Free Software Foundation.
|
*
|
* This program is distributed in the hope that it will be useful,
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
* GNU General Public License for more details.
|
*
|
*
|
*/
|
#include <linux/errno.h>
|
#include <linux/firmware.h>
|
#include <linux/pci.h>
|
#include <linux/interrupt.h>
|
#include <linux/io.h>
|
#include <linux/kernel.h>
|
#include <linux/kfifo.h>
|
#include <linux/pm_runtime.h>
|
#include <linux/timer.h>
|
|
#include <asm/iosf_mbi.h>
|
|
#include <media/v4l2-event.h>
|
#include <media/videobuf-vmalloc.h>
|
|
#define CREATE_TRACE_POINTS
|
#include "atomisp_trace_event.h"
|
|
#include "atomisp_cmd.h"
|
#include "atomisp_common.h"
|
#include "atomisp_fops.h"
|
#include "atomisp_internal.h"
|
#include "atomisp_ioctl.h"
|
#include "atomisp-regs.h"
|
#include "atomisp_tables.h"
|
#include "atomisp_acc.h"
|
#include "atomisp_compat.h"
|
#include "atomisp_subdev.h"
|
#include "atomisp_dfs_tables.h"
|
|
#include <hmm/hmm.h>
|
|
#include "sh_css_hrt.h"
|
#include "sh_css_defs.h"
|
#include "system_global.h"
|
#include "sh_css_internal.h"
|
#include "sh_css_sp.h"
|
#include "gp_device.h"
|
#include "device_access.h"
|
#include "irq.h"
|
|
#include "ia_css_types.h"
|
#include "ia_css_stream.h"
|
#include "ia_css_debug.h"
|
#include "bits.h"
|
|
/* We should never need to run the flash for more than 2 frames.
|
* At 15fps this means 133ms. We set the timeout a bit longer.
|
* Each flash driver is supposed to set its own timeout, but
|
* just in case someone else changed the timeout, we set it
|
* here to make sure we don't damage the flash hardware. */
|
#define FLASH_TIMEOUT 800 /* ms */
|
|
union host {
|
struct {
|
void *kernel_ptr;
|
void __user *user_ptr;
|
int size;
|
} scalar;
|
struct {
|
void *hmm_ptr;
|
} ptr;
|
};
|
|
/*
|
* get sensor:dis71430/ov2720 related info from v4l2_subdev->priv data field.
|
* subdev->priv is set in mrst.c
|
*/
|
struct camera_mipi_info *atomisp_to_sensor_mipi_info(struct v4l2_subdev *sd)
|
{
|
return (struct camera_mipi_info *)v4l2_get_subdev_hostdata(sd);
|
}
|
|
/*
|
* get struct atomisp_video_pipe from v4l2 video_device
|
*/
|
struct atomisp_video_pipe *atomisp_to_video_pipe(struct video_device *dev)
|
{
|
return (struct atomisp_video_pipe *)
|
container_of(dev, struct atomisp_video_pipe, vdev);
|
}
|
|
/*
|
* get struct atomisp_acc_pipe from v4l2 video_device
|
*/
|
struct atomisp_acc_pipe *atomisp_to_acc_pipe(struct video_device *dev)
|
{
|
return (struct atomisp_acc_pipe *)
|
container_of(dev, struct atomisp_acc_pipe, vdev);
|
}
|
|
static unsigned short atomisp_get_sensor_fps(struct atomisp_sub_device *asd)
|
{
|
struct v4l2_subdev_frame_interval fi = { 0 };
|
struct atomisp_device *isp = asd->isp;
|
|
unsigned short fps = 0;
|
int ret;
|
|
ret = v4l2_subdev_call(isp->inputs[asd->input_curr].camera,
|
video, g_frame_interval, &fi);
|
|
if (!ret && fi.interval.numerator)
|
fps = fi.interval.denominator / fi.interval.numerator;
|
|
return fps;
|
}
|
|
/*
|
* DFS progress is shown as follows:
|
* 1. Target frequency is calculated according to FPS/Resolution/ISP running
|
* mode.
|
* 2. Ratio is calculated using formula: 2 * HPLL / target frequency - 1
|
* with proper rounding.
|
* 3. Set ratio to ISPFREQ40, 1 to FREQVALID and ISPFREQGUAR40
|
* to 200MHz in ISPSSPM1.
|
* 4. Wait for FREQVALID to be cleared by P-Unit.
|
* 5. Wait for field ISPFREQSTAT40 in ISPSSPM1 turn to ratio set in 3.
|
*/
|
static int write_target_freq_to_hw(struct atomisp_device *isp,
|
unsigned int new_freq)
|
{
|
unsigned int ratio, timeout, guar_ratio;
|
u32 isp_sspm1 = 0;
|
int i;
|
|
if (!isp->hpll_freq) {
|
dev_err(isp->dev, "failed to get hpll_freq. no change to freq\n");
|
return -EINVAL;
|
}
|
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
if (isp_sspm1 & ISP_FREQ_VALID_MASK) {
|
dev_dbg(isp->dev, "clearing ISPSSPM1 valid bit.\n");
|
iosf_mbi_write(BT_MBI_UNIT_PMC, MBI_REG_WRITE, ISPSSPM1,
|
isp_sspm1 & ~(1 << ISP_FREQ_VALID_OFFSET));
|
}
|
|
ratio = (2 * isp->hpll_freq + new_freq / 2) / new_freq - 1;
|
guar_ratio = (2 * isp->hpll_freq + 200 / 2) / 200 - 1;
|
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
isp_sspm1 &= ~(0x1F << ISP_REQ_FREQ_OFFSET);
|
|
for (i = 0; i < ISP_DFS_TRY_TIMES; i++) {
|
iosf_mbi_write(BT_MBI_UNIT_PMC, MBI_REG_WRITE, ISPSSPM1,
|
isp_sspm1
|
| ratio << ISP_REQ_FREQ_OFFSET
|
| 1 << ISP_FREQ_VALID_OFFSET
|
| guar_ratio << ISP_REQ_GUAR_FREQ_OFFSET);
|
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
timeout = 20;
|
while ((isp_sspm1 & ISP_FREQ_VALID_MASK) && timeout) {
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
dev_dbg(isp->dev, "waiting for ISPSSPM1 valid bit to be 0.\n");
|
udelay(100);
|
timeout--;
|
}
|
|
if (timeout != 0)
|
break;
|
}
|
|
if (timeout == 0) {
|
dev_err(isp->dev, "DFS failed due to HW error.\n");
|
return -EINVAL;
|
}
|
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
timeout = 10;
|
while (((isp_sspm1 >> ISP_FREQ_STAT_OFFSET) != ratio) && timeout) {
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
dev_dbg(isp->dev, "waiting for ISPSSPM1 status bit to be 0x%x.\n",
|
new_freq);
|
udelay(100);
|
timeout--;
|
}
|
if (timeout == 0) {
|
dev_err(isp->dev, "DFS target freq is rejected by HW.\n");
|
return -EINVAL;
|
}
|
|
return 0;
|
}
|
|
int atomisp_freq_scaling(struct atomisp_device *isp,
|
enum atomisp_dfs_mode mode,
|
bool force)
|
{
|
struct pci_dev *pdev = to_pci_dev(isp->dev);
|
/* FIXME! Only use subdev[0] status yet */
|
struct atomisp_sub_device *asd = &isp->asd[0];
|
const struct atomisp_dfs_config *dfs;
|
unsigned int new_freq;
|
struct atomisp_freq_scaling_rule curr_rules;
|
int i, ret;
|
unsigned short fps = 0;
|
|
if (isp->sw_contex.power_state != ATOM_ISP_POWER_UP) {
|
dev_err(isp->dev, "DFS cannot proceed due to no power.\n");
|
return -EINVAL;
|
}
|
|
if ((pdev->device & ATOMISP_PCI_DEVICE_SOC_MASK) ==
|
ATOMISP_PCI_DEVICE_SOC_CHT && ATOMISP_USE_YUVPP(asd))
|
isp->dfs = &dfs_config_cht_soc;
|
|
dfs = isp->dfs;
|
|
if (dfs->lowest_freq == 0 || dfs->max_freq_at_vmin == 0 ||
|
dfs->highest_freq == 0 || dfs->dfs_table_size == 0 ||
|
!dfs->dfs_table) {
|
dev_err(isp->dev, "DFS configuration is invalid.\n");
|
return -EINVAL;
|
}
|
|
if (mode == ATOMISP_DFS_MODE_LOW) {
|
new_freq = dfs->lowest_freq;
|
goto done;
|
}
|
|
if (mode == ATOMISP_DFS_MODE_MAX) {
|
new_freq = dfs->highest_freq;
|
goto done;
|
}
|
|
fps = atomisp_get_sensor_fps(asd);
|
if (fps == 0) {
|
dev_info(isp->dev,
|
"Sensor didn't report FPS. Using DFS max mode.\n");
|
new_freq = dfs->highest_freq;
|
goto done;
|
}
|
|
curr_rules.width = asd->fmt[asd->capture_pad].fmt.width;
|
curr_rules.height = asd->fmt[asd->capture_pad].fmt.height;
|
curr_rules.fps = fps;
|
curr_rules.run_mode = asd->run_mode->val;
|
/*
|
* For continuous mode, we need to make the capture setting applied
|
* since preview mode, because there is no chance to do this when
|
* starting image capture.
|
*/
|
if (asd->continuous_mode->val) {
|
if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO)
|
curr_rules.run_mode = ATOMISP_RUN_MODE_SDV;
|
else
|
curr_rules.run_mode =
|
ATOMISP_RUN_MODE_CONTINUOUS_CAPTURE;
|
}
|
|
/* search for the target frequency by looping freq rules*/
|
for (i = 0; i < dfs->dfs_table_size; i++) {
|
if (curr_rules.width != dfs->dfs_table[i].width &&
|
dfs->dfs_table[i].width != ISP_FREQ_RULE_ANY)
|
continue;
|
if (curr_rules.height != dfs->dfs_table[i].height &&
|
dfs->dfs_table[i].height != ISP_FREQ_RULE_ANY)
|
continue;
|
if (curr_rules.fps != dfs->dfs_table[i].fps &&
|
dfs->dfs_table[i].fps != ISP_FREQ_RULE_ANY)
|
continue;
|
if (curr_rules.run_mode != dfs->dfs_table[i].run_mode &&
|
dfs->dfs_table[i].run_mode != ISP_FREQ_RULE_ANY)
|
continue;
|
break;
|
}
|
|
if (i == dfs->dfs_table_size)
|
new_freq = dfs->max_freq_at_vmin;
|
else
|
new_freq = dfs->dfs_table[i].isp_freq;
|
|
done:
|
dev_dbg(isp->dev, "DFS target frequency=%d.\n", new_freq);
|
|
if ((new_freq == isp->sw_contex.running_freq) && !force)
|
return 0;
|
|
dev_dbg(isp->dev, "Programming DFS frequency to %d\n", new_freq);
|
|
ret = write_target_freq_to_hw(isp, new_freq);
|
if (!ret) {
|
isp->sw_contex.running_freq = new_freq;
|
trace_ipu_pstate(new_freq, -1);
|
}
|
return ret;
|
}
|
|
/*
|
* reset and restore ISP
|
*/
|
int atomisp_reset(struct atomisp_device *isp)
|
{
|
/* Reset ISP by power-cycling it */
|
int ret = 0;
|
|
dev_dbg(isp->dev, "%s\n", __func__);
|
atomisp_css_suspend(isp);
|
ret = atomisp_runtime_suspend(isp->dev);
|
if (ret < 0)
|
dev_err(isp->dev, "atomisp_runtime_suspend failed, %d\n", ret);
|
ret = atomisp_mrfld_power_down(isp);
|
if (ret < 0) {
|
dev_err(isp->dev, "can not disable ISP power\n");
|
} else {
|
ret = atomisp_mrfld_power_up(isp);
|
if (ret < 0)
|
dev_err(isp->dev, "can not enable ISP power\n");
|
ret = atomisp_runtime_resume(isp->dev);
|
if (ret < 0)
|
dev_err(isp->dev, "atomisp_runtime_resume failed, %d\n", ret);
|
}
|
ret = atomisp_css_resume(isp);
|
if (ret)
|
isp->isp_fatal_error = true;
|
|
return ret;
|
}
|
|
/*
|
* interrupt disable functions
|
*/
|
static void disable_isp_irq(enum hrt_isp_css_irq irq)
|
{
|
irq_disable_channel(IRQ0_ID, irq);
|
|
if (irq != hrt_isp_css_irq_sp)
|
return;
|
|
cnd_sp_irq_enable(SP0_ID, false);
|
}
|
|
/*
|
* interrupt clean function
|
*/
|
static void clear_isp_irq(enum hrt_isp_css_irq irq)
|
{
|
irq_clear_all(IRQ0_ID);
|
}
|
|
void atomisp_msi_irq_init(struct atomisp_device *isp)
|
{
|
struct pci_dev *pdev = to_pci_dev(isp->dev);
|
u32 msg32;
|
u16 msg16;
|
|
pci_read_config_dword(pdev, PCI_MSI_CAPID, &msg32);
|
msg32 |= 1 << MSI_ENABLE_BIT;
|
pci_write_config_dword(pdev, PCI_MSI_CAPID, msg32);
|
|
msg32 = (1 << INTR_IER) | (1 << INTR_IIR);
|
pci_write_config_dword(pdev, PCI_INTERRUPT_CTRL, msg32);
|
|
pci_read_config_word(pdev, PCI_COMMAND, &msg16);
|
msg16 |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER |
|
PCI_COMMAND_INTX_DISABLE);
|
pci_write_config_word(pdev, PCI_COMMAND, msg16);
|
}
|
|
void atomisp_msi_irq_uninit(struct atomisp_device *isp)
|
{
|
struct pci_dev *pdev = to_pci_dev(isp->dev);
|
u32 msg32;
|
u16 msg16;
|
|
pci_read_config_dword(pdev, PCI_MSI_CAPID, &msg32);
|
msg32 &= ~(1 << MSI_ENABLE_BIT);
|
pci_write_config_dword(pdev, PCI_MSI_CAPID, msg32);
|
|
msg32 = 0x0;
|
pci_write_config_dword(pdev, PCI_INTERRUPT_CTRL, msg32);
|
|
pci_read_config_word(pdev, PCI_COMMAND, &msg16);
|
msg16 &= ~(PCI_COMMAND_MASTER);
|
pci_write_config_word(pdev, PCI_COMMAND, msg16);
|
}
|
|
static void atomisp_sof_event(struct atomisp_sub_device *asd)
|
{
|
struct v4l2_event event = {0};
|
|
event.type = V4L2_EVENT_FRAME_SYNC;
|
event.u.frame_sync.frame_sequence = atomic_read(&asd->sof_count);
|
|
v4l2_event_queue(asd->subdev.devnode, &event);
|
}
|
|
void atomisp_eof_event(struct atomisp_sub_device *asd, uint8_t exp_id)
|
{
|
struct v4l2_event event = {0};
|
|
event.type = V4L2_EVENT_FRAME_END;
|
event.u.frame_sync.frame_sequence = exp_id;
|
|
v4l2_event_queue(asd->subdev.devnode, &event);
|
}
|
|
static void atomisp_3a_stats_ready_event(struct atomisp_sub_device *asd,
|
uint8_t exp_id)
|
{
|
struct v4l2_event event = {0};
|
|
event.type = V4L2_EVENT_ATOMISP_3A_STATS_READY;
|
event.u.frame_sync.frame_sequence = exp_id;
|
|
v4l2_event_queue(asd->subdev.devnode, &event);
|
}
|
|
static void atomisp_metadata_ready_event(struct atomisp_sub_device *asd,
|
enum atomisp_metadata_type md_type)
|
{
|
struct v4l2_event event = {0};
|
|
event.type = V4L2_EVENT_ATOMISP_METADATA_READY;
|
event.u.data[0] = md_type;
|
|
v4l2_event_queue(asd->subdev.devnode, &event);
|
}
|
|
static void atomisp_reset_event(struct atomisp_sub_device *asd)
|
{
|
struct v4l2_event event = {0};
|
|
event.type = V4L2_EVENT_ATOMISP_CSS_RESET;
|
|
v4l2_event_queue(asd->subdev.devnode, &event);
|
}
|
|
static void print_csi_rx_errors(enum mipi_port_id port,
|
struct atomisp_device *isp)
|
{
|
u32 infos = 0;
|
|
atomisp_css_rx_get_irq_info(port, &infos);
|
|
dev_err(isp->dev, "CSI Receiver port %d errors:\n", port);
|
if (infos & IA_CSS_RX_IRQ_INFO_BUFFER_OVERRUN)
|
dev_err(isp->dev, " buffer overrun");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_SOT)
|
dev_err(isp->dev, " start-of-transmission error");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_SOT_SYNC)
|
dev_err(isp->dev, " start-of-transmission sync error");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_CONTROL)
|
dev_err(isp->dev, " control error");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_ECC_DOUBLE)
|
dev_err(isp->dev, " 2 or more ECC errors");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_CRC)
|
dev_err(isp->dev, " CRC mismatch");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_UNKNOWN_ID)
|
dev_err(isp->dev, " unknown error");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_FRAME_SYNC)
|
dev_err(isp->dev, " frame sync error");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_FRAME_DATA)
|
dev_err(isp->dev, " frame data error");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_DATA_TIMEOUT)
|
dev_err(isp->dev, " data timeout");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_UNKNOWN_ESC)
|
dev_err(isp->dev, " unknown escape command entry");
|
if (infos & IA_CSS_RX_IRQ_INFO_ERR_LINE_SYNC)
|
dev_err(isp->dev, " line sync error");
|
}
|
|
/* Clear irq reg */
|
static void clear_irq_reg(struct atomisp_device *isp)
|
{
|
struct pci_dev *pdev = to_pci_dev(isp->dev);
|
u32 msg_ret;
|
|
pci_read_config_dword(pdev, PCI_INTERRUPT_CTRL, &msg_ret);
|
msg_ret |= 1 << INTR_IIR;
|
pci_write_config_dword(pdev, PCI_INTERRUPT_CTRL, msg_ret);
|
}
|
|
static struct atomisp_sub_device *
|
__get_asd_from_port(struct atomisp_device *isp, enum mipi_port_id port)
|
{
|
int i;
|
|
/* Check which isp subdev to send eof */
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
struct camera_mipi_info *mipi_info;
|
|
mipi_info = atomisp_to_sensor_mipi_info(
|
isp->inputs[asd->input_curr].camera);
|
|
if (asd->streaming == ATOMISP_DEVICE_STREAMING_ENABLED &&
|
__get_mipi_port(isp, mipi_info->port) == port) {
|
return asd;
|
}
|
}
|
|
return NULL;
|
}
|
|
/* interrupt handling function*/
|
irqreturn_t atomisp_isr(int irq, void *dev)
|
{
|
struct atomisp_device *isp = (struct atomisp_device *)dev;
|
struct atomisp_sub_device *asd;
|
struct atomisp_css_event eof_event;
|
unsigned int irq_infos = 0;
|
unsigned long flags;
|
unsigned int i;
|
int err;
|
|
spin_lock_irqsave(&isp->lock, flags);
|
if (isp->sw_contex.power_state != ATOM_ISP_POWER_UP ||
|
!isp->css_initialized) {
|
spin_unlock_irqrestore(&isp->lock, flags);
|
return IRQ_HANDLED;
|
}
|
err = atomisp_css_irq_translate(isp, &irq_infos);
|
if (err) {
|
spin_unlock_irqrestore(&isp->lock, flags);
|
return IRQ_NONE;
|
}
|
|
clear_irq_reg(isp);
|
|
if (!atomisp_streaming_count(isp) && !atomisp_is_acc_enabled(isp))
|
goto out_nowake;
|
|
for (i = 0; i < isp->num_of_streams; i++) {
|
asd = &isp->asd[i];
|
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED)
|
continue;
|
/*
|
* Current SOF only support one stream, so the SOF only valid
|
* either solely one stream is running
|
*/
|
if (irq_infos & IA_CSS_IRQ_INFO_CSS_RECEIVER_SOF) {
|
atomic_inc(&asd->sof_count);
|
atomisp_sof_event(asd);
|
|
/* If sequence_temp and sequence are the same
|
* there where no frames lost so we can increase
|
* sequence_temp.
|
* If not then processing of frame is still in progress
|
* and driver needs to keep old sequence_temp value.
|
* NOTE: There is assumption here that ISP will not
|
* start processing next frame from sensor before old
|
* one is completely done. */
|
if (atomic_read(&asd->sequence) == atomic_read(
|
&asd->sequence_temp))
|
atomic_set(&asd->sequence_temp,
|
atomic_read(&asd->sof_count));
|
}
|
if (irq_infos & IA_CSS_IRQ_INFO_EVENTS_READY)
|
atomic_set(&asd->sequence,
|
atomic_read(&asd->sequence_temp));
|
}
|
|
if (irq_infos & IA_CSS_IRQ_INFO_CSS_RECEIVER_SOF) {
|
dev_dbg_ratelimited(isp->dev,
|
"irq:0x%x (SOF)\n",
|
irq_infos);
|
irq_infos &= ~IA_CSS_IRQ_INFO_CSS_RECEIVER_SOF;
|
}
|
|
if ((irq_infos & IA_CSS_IRQ_INFO_INPUT_SYSTEM_ERROR) ||
|
(irq_infos & IA_CSS_IRQ_INFO_IF_ERROR)) {
|
/* handle mipi receiver error */
|
u32 rx_infos;
|
enum mipi_port_id port;
|
|
for (port = MIPI_PORT0_ID; port <= MIPI_PORT2_ID;
|
port++) {
|
print_csi_rx_errors(port, isp);
|
atomisp_css_rx_get_irq_info(port, &rx_infos);
|
atomisp_css_rx_clear_irq_info(port, rx_infos);
|
}
|
}
|
|
if (irq_infos & IA_CSS_IRQ_INFO_ISYS_EVENTS_READY) {
|
while (ia_css_dequeue_isys_event(&eof_event.event) ==
|
0) {
|
/* EOF Event does not have the css_pipe returned */
|
asd = __get_asd_from_port(isp, eof_event.event.port);
|
if (!asd) {
|
dev_err(isp->dev, "%s: ISYS event, but no subdev.event:%d",
|
__func__, eof_event.event.type);
|
continue;
|
}
|
|
atomisp_eof_event(asd, eof_event.event.exp_id);
|
dev_dbg_ratelimited(isp->dev,
|
"%s ISYS event: EOF exp_id %d, asd %d\n",
|
__func__, eof_event.event.exp_id,
|
asd->index);
|
}
|
|
irq_infos &= ~IA_CSS_IRQ_INFO_ISYS_EVENTS_READY;
|
if (irq_infos == 0)
|
goto out_nowake;
|
}
|
|
spin_unlock_irqrestore(&isp->lock, flags);
|
|
dev_dbg_ratelimited(isp->dev, "irq:0x%x (unhandled)\n", irq_infos);
|
|
return IRQ_WAKE_THREAD;
|
|
out_nowake:
|
spin_unlock_irqrestore(&isp->lock, flags);
|
|
if (irq_infos)
|
dev_dbg_ratelimited(isp->dev, "irq:0x%x (ignored, as not streaming anymore)\n",
|
irq_infos);
|
|
return IRQ_HANDLED;
|
}
|
|
void atomisp_clear_css_buffer_counters(struct atomisp_sub_device *asd)
|
{
|
int i;
|
|
memset(asd->s3a_bufs_in_css, 0, sizeof(asd->s3a_bufs_in_css));
|
for (i = 0; i < ATOMISP_INPUT_STREAM_NUM; i++)
|
memset(asd->metadata_bufs_in_css[i], 0,
|
sizeof(asd->metadata_bufs_in_css[i]));
|
asd->dis_bufs_in_css = 0;
|
asd->video_out_capture.buffers_in_css = 0;
|
asd->video_out_vf.buffers_in_css = 0;
|
asd->video_out_preview.buffers_in_css = 0;
|
asd->video_out_video_capture.buffers_in_css = 0;
|
}
|
|
/* ISP2400 */
|
bool atomisp_buffers_queued(struct atomisp_sub_device *asd)
|
{
|
return asd->video_out_capture.buffers_in_css ||
|
asd->video_out_vf.buffers_in_css ||
|
asd->video_out_preview.buffers_in_css ||
|
asd->video_out_video_capture.buffers_in_css;
|
}
|
|
/* ISP2401 */
|
bool atomisp_buffers_queued_pipe(struct atomisp_video_pipe *pipe)
|
{
|
return pipe->buffers_in_css ? true : false;
|
}
|
|
/* 0x100000 is the start of dmem inside SP */
|
#define SP_DMEM_BASE 0x100000
|
|
void dump_sp_dmem(struct atomisp_device *isp, unsigned int addr,
|
unsigned int size)
|
{
|
unsigned int data = 0;
|
unsigned int size32 = DIV_ROUND_UP(size, sizeof(u32));
|
|
dev_dbg(isp->dev, "atomisp mmio base: %p\n", isp->base);
|
dev_dbg(isp->dev, "%s, addr:0x%x, size: %d, size32: %d\n", __func__,
|
addr, size, size32);
|
if (size32 * 4 + addr > 0x4000) {
|
dev_err(isp->dev, "illegal size (%d) or addr (0x%x)\n",
|
size32, addr);
|
return;
|
}
|
addr += SP_DMEM_BASE;
|
addr &= 0x003FFFFF;
|
do {
|
data = readl(isp->base + addr);
|
dev_dbg(isp->dev, "%s, \t [0x%x]:0x%x\n", __func__, addr, data);
|
addr += sizeof(u32);
|
} while (--size32);
|
}
|
|
static struct videobuf_buffer *atomisp_css_frame_to_vbuf(
|
struct atomisp_video_pipe *pipe, struct ia_css_frame *frame)
|
{
|
struct videobuf_vmalloc_memory *vm_mem;
|
struct ia_css_frame *handle;
|
int i;
|
|
for (i = 0; pipe->capq.bufs[i]; i++) {
|
vm_mem = pipe->capq.bufs[i]->priv;
|
handle = vm_mem->vaddr;
|
if (handle && handle->data == frame->data)
|
return pipe->capq.bufs[i];
|
}
|
|
return NULL;
|
}
|
|
static void atomisp_flush_video_pipe(struct atomisp_sub_device *asd,
|
struct atomisp_video_pipe *pipe)
|
{
|
unsigned long irqflags;
|
int i;
|
|
if (!pipe->users)
|
return;
|
|
for (i = 0; pipe->capq.bufs[i]; i++) {
|
spin_lock_irqsave(&pipe->irq_lock, irqflags);
|
if (pipe->capq.bufs[i]->state == VIDEOBUF_ACTIVE ||
|
pipe->capq.bufs[i]->state == VIDEOBUF_QUEUED) {
|
pipe->capq.bufs[i]->ts = ktime_get_ns();
|
pipe->capq.bufs[i]->field_count =
|
atomic_read(&asd->sequence) << 1;
|
dev_dbg(asd->isp->dev, "release buffers on device %s\n",
|
pipe->vdev.name);
|
if (pipe->capq.bufs[i]->state == VIDEOBUF_QUEUED)
|
list_del_init(&pipe->capq.bufs[i]->queue);
|
pipe->capq.bufs[i]->state = VIDEOBUF_ERROR;
|
wake_up(&pipe->capq.bufs[i]->done);
|
}
|
spin_unlock_irqrestore(&pipe->irq_lock, irqflags);
|
}
|
}
|
|
/* Returns queued buffers back to video-core */
|
void atomisp_flush_bufs_and_wakeup(struct atomisp_sub_device *asd)
|
{
|
atomisp_flush_video_pipe(asd, &asd->video_out_capture);
|
atomisp_flush_video_pipe(asd, &asd->video_out_vf);
|
atomisp_flush_video_pipe(asd, &asd->video_out_preview);
|
atomisp_flush_video_pipe(asd, &asd->video_out_video_capture);
|
}
|
|
/* clean out the parameters that did not apply */
|
void atomisp_flush_params_queue(struct atomisp_video_pipe *pipe)
|
{
|
struct atomisp_css_params_with_list *param;
|
|
while (!list_empty(&pipe->per_frame_params)) {
|
param = list_entry(pipe->per_frame_params.next,
|
struct atomisp_css_params_with_list, list);
|
list_del(¶m->list);
|
atomisp_free_css_parameters(¶m->params);
|
kvfree(param);
|
}
|
}
|
|
/* Re-queue per-frame parameters */
|
static void atomisp_recover_params_queue(struct atomisp_video_pipe *pipe)
|
{
|
struct atomisp_css_params_with_list *param;
|
int i;
|
|
for (i = 0; i < VIDEO_MAX_FRAME; i++) {
|
param = pipe->frame_params[i];
|
if (param)
|
list_add_tail(¶m->list, &pipe->per_frame_params);
|
pipe->frame_params[i] = NULL;
|
}
|
atomisp_handle_parameter_and_buffer(pipe);
|
}
|
|
/* find atomisp_video_pipe with css pipe id, buffer type and atomisp run_mode */
|
static struct atomisp_video_pipe *__atomisp_get_pipe(
|
struct atomisp_sub_device *asd,
|
enum atomisp_input_stream_id stream_id,
|
enum ia_css_pipe_id css_pipe_id,
|
enum ia_css_buffer_type buf_type)
|
{
|
struct atomisp_device *isp = asd->isp;
|
|
if (css_pipe_id == IA_CSS_PIPE_ID_COPY &&
|
isp->inputs[asd->input_curr].camera_caps->
|
sensor[asd->sensor_curr].stream_num > 1) {
|
switch (stream_id) {
|
case ATOMISP_INPUT_STREAM_PREVIEW:
|
return &asd->video_out_preview;
|
case ATOMISP_INPUT_STREAM_POSTVIEW:
|
return &asd->video_out_vf;
|
case ATOMISP_INPUT_STREAM_VIDEO:
|
return &asd->video_out_video_capture;
|
case ATOMISP_INPUT_STREAM_CAPTURE:
|
default:
|
return &asd->video_out_capture;
|
}
|
}
|
|
/* video is same in online as in continuouscapture mode */
|
if (asd->vfpp->val == ATOMISP_VFPP_DISABLE_LOWLAT) {
|
/*
|
* Disable vf_pp and run CSS in still capture mode. In this
|
* mode, CSS does not cause extra latency with buffering, but
|
* scaling is not available.
|
*/
|
return &asd->video_out_capture;
|
} else if (asd->vfpp->val == ATOMISP_VFPP_DISABLE_SCALER) {
|
/*
|
* Disable vf_pp and run CSS in video mode. This allows using
|
* ISP scaling but it has one frame delay due to CSS internal
|
* buffering.
|
*/
|
return &asd->video_out_video_capture;
|
} else if (css_pipe_id == IA_CSS_PIPE_ID_YUVPP) {
|
/*
|
* to SOC camera, yuvpp pipe is run for capture/video/SDV/ZSL.
|
*/
|
if (asd->continuous_mode->val) {
|
if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO) {
|
/* SDV case */
|
switch (buf_type) {
|
case IA_CSS_BUFFER_TYPE_SEC_OUTPUT_FRAME:
|
return &asd->video_out_video_capture;
|
case IA_CSS_BUFFER_TYPE_SEC_VF_OUTPUT_FRAME:
|
return &asd->video_out_preview;
|
case IA_CSS_BUFFER_TYPE_OUTPUT_FRAME:
|
return &asd->video_out_capture;
|
default:
|
return &asd->video_out_vf;
|
}
|
} else if (asd->run_mode->val == ATOMISP_RUN_MODE_PREVIEW) {
|
/* ZSL case */
|
switch (buf_type) {
|
case IA_CSS_BUFFER_TYPE_SEC_OUTPUT_FRAME:
|
return &asd->video_out_preview;
|
case IA_CSS_BUFFER_TYPE_OUTPUT_FRAME:
|
return &asd->video_out_capture;
|
default:
|
return &asd->video_out_vf;
|
}
|
}
|
} else if (buf_type == IA_CSS_BUFFER_TYPE_OUTPUT_FRAME) {
|
switch (asd->run_mode->val) {
|
case ATOMISP_RUN_MODE_VIDEO:
|
return &asd->video_out_video_capture;
|
case ATOMISP_RUN_MODE_PREVIEW:
|
return &asd->video_out_preview;
|
default:
|
return &asd->video_out_capture;
|
}
|
} else if (buf_type == IA_CSS_BUFFER_TYPE_VF_OUTPUT_FRAME) {
|
if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO)
|
return &asd->video_out_preview;
|
else
|
return &asd->video_out_vf;
|
}
|
} else if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO) {
|
/* For online video or SDV video pipe. */
|
if (css_pipe_id == IA_CSS_PIPE_ID_VIDEO ||
|
css_pipe_id == IA_CSS_PIPE_ID_COPY) {
|
if (buf_type == IA_CSS_BUFFER_TYPE_OUTPUT_FRAME)
|
return &asd->video_out_video_capture;
|
return &asd->video_out_preview;
|
}
|
} else if (asd->run_mode->val == ATOMISP_RUN_MODE_PREVIEW) {
|
/* For online preview or ZSL preview pipe. */
|
if (css_pipe_id == IA_CSS_PIPE_ID_PREVIEW ||
|
css_pipe_id == IA_CSS_PIPE_ID_COPY)
|
return &asd->video_out_preview;
|
}
|
/* For capture pipe. */
|
if (buf_type == IA_CSS_BUFFER_TYPE_VF_OUTPUT_FRAME)
|
return &asd->video_out_vf;
|
return &asd->video_out_capture;
|
}
|
|
enum atomisp_metadata_type
|
atomisp_get_metadata_type(struct atomisp_sub_device *asd,
|
enum ia_css_pipe_id pipe_id)
|
{
|
if (!asd->continuous_mode->val)
|
return ATOMISP_MAIN_METADATA;
|
|
if (pipe_id == IA_CSS_PIPE_ID_CAPTURE) /* online capture pipe */
|
return ATOMISP_SEC_METADATA;
|
else
|
return ATOMISP_MAIN_METADATA;
|
}
|
|
void atomisp_buf_done(struct atomisp_sub_device *asd, int error,
|
enum ia_css_buffer_type buf_type,
|
enum ia_css_pipe_id css_pipe_id,
|
bool q_buffers, enum atomisp_input_stream_id stream_id)
|
{
|
struct videobuf_buffer *vb = NULL;
|
struct atomisp_video_pipe *pipe = NULL;
|
struct atomisp_css_buffer buffer;
|
bool requeue = false;
|
int err;
|
unsigned long irqflags;
|
struct ia_css_frame *frame = NULL;
|
struct atomisp_s3a_buf *s3a_buf = NULL, *_s3a_buf_tmp, *s3a_iter;
|
struct atomisp_dis_buf *dis_buf = NULL, *_dis_buf_tmp, *dis_iter;
|
struct atomisp_metadata_buf *md_buf = NULL, *_md_buf_tmp, *md_iter;
|
enum atomisp_metadata_type md_type;
|
struct atomisp_device *isp = asd->isp;
|
struct v4l2_control ctrl;
|
bool reset_wdt_timer = false;
|
|
if (
|
buf_type != IA_CSS_BUFFER_TYPE_METADATA &&
|
buf_type != IA_CSS_BUFFER_TYPE_3A_STATISTICS &&
|
buf_type != IA_CSS_BUFFER_TYPE_DIS_STATISTICS &&
|
buf_type != IA_CSS_BUFFER_TYPE_OUTPUT_FRAME &&
|
buf_type != IA_CSS_BUFFER_TYPE_SEC_OUTPUT_FRAME &&
|
buf_type != IA_CSS_BUFFER_TYPE_RAW_OUTPUT_FRAME &&
|
buf_type != IA_CSS_BUFFER_TYPE_SEC_VF_OUTPUT_FRAME &&
|
buf_type != IA_CSS_BUFFER_TYPE_VF_OUTPUT_FRAME) {
|
dev_err(isp->dev, "%s, unsupported buffer type: %d\n",
|
__func__, buf_type);
|
return;
|
}
|
|
memset(&buffer, 0, sizeof(struct atomisp_css_buffer));
|
buffer.css_buffer.type = buf_type;
|
err = atomisp_css_dequeue_buffer(asd, stream_id, css_pipe_id,
|
buf_type, &buffer);
|
if (err) {
|
dev_err(isp->dev,
|
"atomisp_css_dequeue_buffer failed: 0x%x\n", err);
|
return;
|
}
|
|
/* need to know the atomisp pipe for frame buffers */
|
pipe = __atomisp_get_pipe(asd, stream_id, css_pipe_id, buf_type);
|
if (!pipe) {
|
dev_err(isp->dev, "error getting atomisp pipe\n");
|
return;
|
}
|
|
switch (buf_type) {
|
case IA_CSS_BUFFER_TYPE_3A_STATISTICS:
|
list_for_each_entry_safe(s3a_iter, _s3a_buf_tmp,
|
&asd->s3a_stats_in_css, list) {
|
if (s3a_iter->s3a_data ==
|
buffer.css_buffer.data.stats_3a) {
|
list_del_init(&s3a_iter->list);
|
list_add_tail(&s3a_iter->list,
|
&asd->s3a_stats_ready);
|
s3a_buf = s3a_iter;
|
break;
|
}
|
}
|
|
asd->s3a_bufs_in_css[css_pipe_id]--;
|
atomisp_3a_stats_ready_event(asd, buffer.css_buffer.exp_id);
|
if (s3a_buf)
|
dev_dbg(isp->dev, "%s: s3a stat with exp_id %d is ready\n",
|
__func__, s3a_buf->s3a_data->exp_id);
|
else
|
dev_dbg(isp->dev, "%s: s3a stat is ready with no exp_id found\n",
|
__func__);
|
break;
|
case IA_CSS_BUFFER_TYPE_METADATA:
|
if (error)
|
break;
|
|
md_type = atomisp_get_metadata_type(asd, css_pipe_id);
|
list_for_each_entry_safe(md_iter, _md_buf_tmp,
|
&asd->metadata_in_css[md_type], list) {
|
if (md_iter->metadata ==
|
buffer.css_buffer.data.metadata) {
|
list_del_init(&md_iter->list);
|
list_add_tail(&md_iter->list,
|
&asd->metadata_ready[md_type]);
|
md_buf = md_iter;
|
break;
|
}
|
}
|
asd->metadata_bufs_in_css[stream_id][css_pipe_id]--;
|
atomisp_metadata_ready_event(asd, md_type);
|
if (md_buf)
|
dev_dbg(isp->dev, "%s: metadata with exp_id %d is ready\n",
|
__func__, md_buf->metadata->exp_id);
|
else
|
dev_dbg(isp->dev, "%s: metadata is ready with no exp_id found\n",
|
__func__);
|
break;
|
case IA_CSS_BUFFER_TYPE_DIS_STATISTICS:
|
list_for_each_entry_safe(dis_iter, _dis_buf_tmp,
|
&asd->dis_stats_in_css, list) {
|
if (dis_iter->dis_data ==
|
buffer.css_buffer.data.stats_dvs) {
|
spin_lock_irqsave(&asd->dis_stats_lock,
|
irqflags);
|
list_del_init(&dis_iter->list);
|
list_add(&dis_iter->list, &asd->dis_stats);
|
asd->params.dis_proj_data_valid = true;
|
spin_unlock_irqrestore(&asd->dis_stats_lock,
|
irqflags);
|
dis_buf = dis_iter;
|
break;
|
}
|
}
|
asd->dis_bufs_in_css--;
|
if (dis_buf)
|
dev_dbg(isp->dev, "%s: dis stat with exp_id %d is ready\n",
|
__func__, dis_buf->dis_data->exp_id);
|
else
|
dev_dbg(isp->dev, "%s: dis stat is ready with no exp_id found\n",
|
__func__);
|
break;
|
case IA_CSS_BUFFER_TYPE_VF_OUTPUT_FRAME:
|
case IA_CSS_BUFFER_TYPE_SEC_VF_OUTPUT_FRAME:
|
if (IS_ISP2401)
|
reset_wdt_timer = true;
|
|
pipe->buffers_in_css--;
|
frame = buffer.css_buffer.data.frame;
|
if (!frame) {
|
WARN_ON(1);
|
break;
|
}
|
if (!frame->valid)
|
error = true;
|
|
/* FIXME:
|
* YUVPP doesn't set postview exp_id correctlly in SDV mode.
|
* This is a WORKAROUND to set exp_id. see HSDES-1503911606.
|
*/
|
if (IS_BYT && buf_type == IA_CSS_BUFFER_TYPE_SEC_VF_OUTPUT_FRAME &&
|
asd->continuous_mode->val && ATOMISP_USE_YUVPP(asd))
|
frame->exp_id = (asd->postview_exp_id++) %
|
(ATOMISP_MAX_EXP_ID + 1);
|
|
dev_dbg(isp->dev, "%s: vf frame with exp_id %d is ready\n",
|
__func__, frame->exp_id);
|
if (asd->params.flash_state == ATOMISP_FLASH_ONGOING) {
|
if (frame->flash_state
|
== IA_CSS_FRAME_FLASH_STATE_PARTIAL)
|
dev_dbg(isp->dev, "%s thumb partially flashed\n",
|
__func__);
|
else if (frame->flash_state
|
== IA_CSS_FRAME_FLASH_STATE_FULL)
|
dev_dbg(isp->dev, "%s thumb completely flashed\n",
|
__func__);
|
else
|
dev_dbg(isp->dev, "%s thumb no flash in this frame\n",
|
__func__);
|
}
|
vb = atomisp_css_frame_to_vbuf(pipe, frame);
|
WARN_ON(!vb);
|
if (vb)
|
pipe->frame_config_id[vb->i] = frame->isp_config_id;
|
if (css_pipe_id == IA_CSS_PIPE_ID_CAPTURE &&
|
asd->pending_capture_request > 0) {
|
err = atomisp_css_offline_capture_configure(asd,
|
asd->params.offline_parm.num_captures,
|
asd->params.offline_parm.skip_frames,
|
asd->params.offline_parm.offset);
|
|
asd->pending_capture_request--;
|
|
if (IS_ISP2401)
|
asd->re_trigger_capture = false;
|
|
dev_dbg(isp->dev, "Trigger capture again for new buffer. err=%d\n",
|
err);
|
} else if (IS_ISP2401) {
|
asd->re_trigger_capture = true;
|
}
|
break;
|
case IA_CSS_BUFFER_TYPE_OUTPUT_FRAME:
|
case IA_CSS_BUFFER_TYPE_SEC_OUTPUT_FRAME:
|
if (IS_ISP2401)
|
reset_wdt_timer = true;
|
|
pipe->buffers_in_css--;
|
frame = buffer.css_buffer.data.frame;
|
if (!frame) {
|
WARN_ON(1);
|
break;
|
}
|
|
if (!frame->valid)
|
error = true;
|
|
/* FIXME:
|
* YUVPP doesn't set preview exp_id correctlly in ZSL mode.
|
* This is a WORKAROUND to set exp_id. see HSDES-1503911606.
|
*/
|
if (IS_BYT && buf_type == IA_CSS_BUFFER_TYPE_SEC_OUTPUT_FRAME &&
|
asd->continuous_mode->val && ATOMISP_USE_YUVPP(asd))
|
frame->exp_id = (asd->preview_exp_id++) %
|
(ATOMISP_MAX_EXP_ID + 1);
|
|
dev_dbg(isp->dev, "%s: main frame with exp_id %d is ready\n",
|
__func__, frame->exp_id);
|
vb = atomisp_css_frame_to_vbuf(pipe, frame);
|
if (!vb) {
|
WARN_ON(1);
|
break;
|
}
|
|
/* free the parameters */
|
if (pipe->frame_params[vb->i]) {
|
if (asd->params.dvs_6axis ==
|
pipe->frame_params[vb->i]->params.dvs_6axis)
|
asd->params.dvs_6axis = NULL;
|
atomisp_free_css_parameters(
|
&pipe->frame_params[vb->i]->params);
|
kvfree(pipe->frame_params[vb->i]);
|
pipe->frame_params[vb->i] = NULL;
|
}
|
|
pipe->frame_config_id[vb->i] = frame->isp_config_id;
|
ctrl.id = V4L2_CID_FLASH_MODE;
|
if (asd->params.flash_state == ATOMISP_FLASH_ONGOING) {
|
if (frame->flash_state
|
== IA_CSS_FRAME_FLASH_STATE_PARTIAL) {
|
asd->frame_status[vb->i] =
|
ATOMISP_FRAME_STATUS_FLASH_PARTIAL;
|
dev_dbg(isp->dev, "%s partially flashed\n",
|
__func__);
|
} else if (frame->flash_state
|
== IA_CSS_FRAME_FLASH_STATE_FULL) {
|
asd->frame_status[vb->i] =
|
ATOMISP_FRAME_STATUS_FLASH_EXPOSED;
|
asd->params.num_flash_frames--;
|
dev_dbg(isp->dev, "%s completely flashed\n",
|
__func__);
|
} else {
|
asd->frame_status[vb->i] =
|
ATOMISP_FRAME_STATUS_OK;
|
dev_dbg(isp->dev,
|
"%s no flash in this frame\n",
|
__func__);
|
}
|
|
/* Check if flashing sequence is done */
|
if (asd->frame_status[vb->i] ==
|
ATOMISP_FRAME_STATUS_FLASH_EXPOSED)
|
asd->params.flash_state = ATOMISP_FLASH_DONE;
|
} else if (isp->flash) {
|
if (v4l2_g_ctrl(isp->flash->ctrl_handler, &ctrl) ==
|
0 && ctrl.value == ATOMISP_FLASH_MODE_TORCH) {
|
ctrl.id = V4L2_CID_FLASH_TORCH_INTENSITY;
|
if (v4l2_g_ctrl(isp->flash->ctrl_handler, &ctrl)
|
== 0 && ctrl.value > 0) {
|
asd->frame_status[vb->i] =
|
ATOMISP_FRAME_STATUS_FLASH_EXPOSED;
|
} else {
|
asd->frame_status[vb->i] =
|
ATOMISP_FRAME_STATUS_OK;
|
}
|
} else {
|
asd->frame_status[vb->i] =
|
ATOMISP_FRAME_STATUS_OK;
|
}
|
} else {
|
asd->frame_status[vb->i] = ATOMISP_FRAME_STATUS_OK;
|
}
|
|
asd->params.last_frame_status = asd->frame_status[vb->i];
|
|
if (asd->continuous_mode->val) {
|
if (css_pipe_id == IA_CSS_PIPE_ID_PREVIEW ||
|
css_pipe_id == IA_CSS_PIPE_ID_VIDEO) {
|
asd->latest_preview_exp_id = frame->exp_id;
|
} else if (css_pipe_id ==
|
IA_CSS_PIPE_ID_CAPTURE) {
|
if (asd->run_mode->val ==
|
ATOMISP_RUN_MODE_VIDEO)
|
dev_dbg(isp->dev, "SDV capture raw buffer id: %u\n",
|
frame->exp_id);
|
else
|
dev_dbg(isp->dev, "ZSL capture raw buffer id: %u\n",
|
frame->exp_id);
|
}
|
}
|
/*
|
* Only after enabled the raw buffer lock
|
* and in continuous mode.
|
* in preview/video pipe, each buffer will
|
* be locked automatically, so record it here.
|
*/
|
if (((css_pipe_id == IA_CSS_PIPE_ID_PREVIEW) ||
|
(css_pipe_id == IA_CSS_PIPE_ID_VIDEO)) &&
|
asd->enable_raw_buffer_lock->val &&
|
asd->continuous_mode->val) {
|
atomisp_set_raw_buffer_bitmap(asd, frame->exp_id);
|
WARN_ON(frame->exp_id > ATOMISP_MAX_EXP_ID);
|
}
|
|
if (asd->params.css_update_params_needed) {
|
atomisp_apply_css_parameters(asd,
|
&asd->params.css_param);
|
if (asd->params.css_param.update_flag.dz_config)
|
asd->params.config.dz_config = &asd->params.css_param.dz_config;
|
/* New global dvs 6axis config should be blocked
|
* here if there's a buffer with per-frame parameters
|
* pending in CSS frame buffer queue.
|
* This is to aviod zooming vibration since global
|
* parameters take effect immediately while
|
* per-frame parameters are taken after previous
|
* buffers in CSS got processed.
|
*/
|
if (asd->params.dvs_6axis)
|
atomisp_css_set_dvs_6axis(asd,
|
asd->params.dvs_6axis);
|
else
|
asd->params.css_update_params_needed = false;
|
/* The update flag should not be cleaned here
|
* since it is still going to be used to make up
|
* following per-frame parameters.
|
* This will introduce more copy work since each
|
* time when updating global parameters, the whole
|
* parameter set are applied.
|
* FIXME: A new set of parameter copy functions can
|
* be added to make up per-frame parameters based on
|
* solid structures stored in asd->params.css_param
|
* instead of using shadow pointers in update flag.
|
*/
|
atomisp_css_update_isp_params(asd);
|
}
|
break;
|
default:
|
break;
|
}
|
if (vb) {
|
vb->ts = ktime_get_ns();
|
vb->field_count = atomic_read(&asd->sequence) << 1;
|
/*mark videobuffer done for dequeue*/
|
spin_lock_irqsave(&pipe->irq_lock, irqflags);
|
vb->state = !error ? VIDEOBUF_DONE : VIDEOBUF_ERROR;
|
spin_unlock_irqrestore(&pipe->irq_lock, irqflags);
|
|
/*
|
* Frame capture done, wake up any process block on
|
* current active buffer
|
* possibly hold by videobuf_dqbuf()
|
*/
|
wake_up(&vb->done);
|
}
|
if (IS_ISP2401)
|
atomic_set(&pipe->wdt_count, 0);
|
|
/*
|
* Requeue should only be done for 3a and dis buffers.
|
* Queue/dequeue order will change if driver recycles image buffers.
|
*/
|
if (requeue) {
|
err = atomisp_css_queue_buffer(asd,
|
stream_id, css_pipe_id,
|
buf_type, &buffer);
|
if (err)
|
dev_err(isp->dev, "%s, q to css fails: %d\n",
|
__func__, err);
|
return;
|
}
|
if (!error && q_buffers)
|
atomisp_qbuffers_to_css(asd);
|
|
if (IS_ISP2401) {
|
/* If there are no buffers queued then
|
* delete wdt timer. */
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED)
|
return;
|
if (!atomisp_buffers_queued_pipe(pipe))
|
atomisp_wdt_stop_pipe(pipe, false);
|
else if (reset_wdt_timer)
|
/* SOF irq should not reset wdt timer. */
|
atomisp_wdt_refresh_pipe(pipe,
|
ATOMISP_WDT_KEEP_CURRENT_DELAY);
|
}
|
}
|
|
void atomisp_delayed_init_work(struct work_struct *work)
|
{
|
struct atomisp_sub_device *asd = container_of(work,
|
struct atomisp_sub_device,
|
delayed_init_work);
|
/*
|
* to SOC camera, use yuvpp pipe and no support continuous mode.
|
*/
|
if (!ATOMISP_USE_YUVPP(asd)) {
|
struct v4l2_event event = {0};
|
struct ia_css_stream *stream;
|
|
stream = asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream;
|
|
|
if (ia_css_alloc_continuous_frame_remain(stream))
|
return;
|
|
ia_css_update_continuous_frames(stream);
|
|
event.type = V4L2_EVENT_ATOMISP_RAW_BUFFERS_ALLOC_DONE;
|
v4l2_event_queue(asd->subdev.devnode, &event);
|
}
|
|
/* signal streamon after delayed init is done */
|
asd->delayed_init = ATOMISP_DELAYED_INIT_DONE;
|
complete(&asd->init_done);
|
}
|
|
static void __atomisp_css_recover(struct atomisp_device *isp, bool isp_timeout)
|
{
|
struct pci_dev *pdev = to_pci_dev(isp->dev);
|
enum ia_css_pipe_id css_pipe_id;
|
bool stream_restart[MAX_STREAM_NUM] = {0};
|
bool depth_mode = false;
|
int i, ret, depth_cnt = 0;
|
|
if (!isp->sw_contex.file_input)
|
atomisp_css_irq_enable(isp,
|
IA_CSS_IRQ_INFO_CSS_RECEIVER_SOF, false);
|
|
BUG_ON(isp->num_of_streams > MAX_STREAM_NUM);
|
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
struct ia_css_pipeline *acc_pipeline;
|
struct ia_css_pipe *acc_pipe = NULL;
|
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED &&
|
!asd->stream_prepared)
|
continue;
|
|
/*
|
* AtomISP::waitStageUpdate is blocked when WDT happens.
|
* By calling acc_done() for all loaded fw_handles,
|
* HAL will be unblocked.
|
*/
|
acc_pipe = asd->stream_env[i].pipes[IA_CSS_PIPE_ID_ACC];
|
if (acc_pipe) {
|
acc_pipeline = ia_css_pipe_get_pipeline(acc_pipe);
|
if (acc_pipeline) {
|
struct ia_css_pipeline_stage *stage;
|
|
for (stage = acc_pipeline->stages; stage;
|
stage = stage->next) {
|
const struct ia_css_fw_info *fw;
|
|
fw = stage->firmware;
|
atomisp_acc_done(asd, fw->handle);
|
}
|
}
|
}
|
|
depth_cnt++;
|
|
if (asd->delayed_init == ATOMISP_DELAYED_INIT_QUEUED)
|
cancel_work_sync(&asd->delayed_init_work);
|
|
complete(&asd->init_done);
|
asd->delayed_init = ATOMISP_DELAYED_INIT_NOT_QUEUED;
|
|
stream_restart[asd->index] = true;
|
|
asd->streaming = ATOMISP_DEVICE_STREAMING_STOPPING;
|
|
/* stream off sensor */
|
ret = v4l2_subdev_call(
|
isp->inputs[asd->input_curr].
|
camera, video, s_stream, 0);
|
if (ret)
|
dev_warn(isp->dev,
|
"can't stop streaming on sensor!\n");
|
|
atomisp_acc_unload_extensions(asd);
|
|
atomisp_clear_css_buffer_counters(asd);
|
|
css_pipe_id = atomisp_get_css_pipe_id(asd);
|
atomisp_css_stop(asd, css_pipe_id, true);
|
|
asd->streaming = ATOMISP_DEVICE_STREAMING_DISABLED;
|
|
asd->preview_exp_id = 1;
|
asd->postview_exp_id = 1;
|
/* notify HAL the CSS reset */
|
dev_dbg(isp->dev,
|
"send reset event to %s\n", asd->subdev.devnode->name);
|
atomisp_reset_event(asd);
|
}
|
|
/* clear irq */
|
disable_isp_irq(hrt_isp_css_irq_sp);
|
clear_isp_irq(hrt_isp_css_irq_sp);
|
|
/* Set the SRSE to 3 before resetting */
|
pci_write_config_dword(pdev, PCI_I_CONTROL,
|
isp->saved_regs.i_control | MRFLD_PCI_I_CONTROL_SRSE_RESET_MASK);
|
|
/* reset ISP and restore its state */
|
isp->isp_timeout = true;
|
atomisp_reset(isp);
|
isp->isp_timeout = false;
|
|
if (!isp_timeout) {
|
for (i = 0; i < isp->num_of_streams; i++) {
|
if (isp->asd[i].depth_mode->val)
|
return;
|
}
|
}
|
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
|
if (!stream_restart[i])
|
continue;
|
|
if (isp->inputs[asd->input_curr].type != FILE_INPUT)
|
atomisp_css_input_set_mode(asd,
|
IA_CSS_INPUT_MODE_BUFFERED_SENSOR);
|
|
css_pipe_id = atomisp_get_css_pipe_id(asd);
|
if (atomisp_css_start(asd, css_pipe_id, true))
|
dev_warn(isp->dev,
|
"start SP failed, so do not set streaming to be enable!\n");
|
else
|
asd->streaming = ATOMISP_DEVICE_STREAMING_ENABLED;
|
|
atomisp_csi2_configure(asd);
|
}
|
|
if (!isp->sw_contex.file_input) {
|
atomisp_css_irq_enable(isp, IA_CSS_IRQ_INFO_CSS_RECEIVER_SOF,
|
atomisp_css_valid_sof(isp));
|
|
if (atomisp_freq_scaling(isp, ATOMISP_DFS_MODE_AUTO, true) < 0)
|
dev_dbg(isp->dev, "DFS auto failed while recovering!\n");
|
} else {
|
if (atomisp_freq_scaling(isp, ATOMISP_DFS_MODE_MAX, true) < 0)
|
dev_dbg(isp->dev, "DFS max failed while recovering!\n");
|
}
|
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd;
|
|
asd = &isp->asd[i];
|
|
if (!stream_restart[i])
|
continue;
|
|
if (asd->continuous_mode->val &&
|
asd->delayed_init == ATOMISP_DELAYED_INIT_NOT_QUEUED) {
|
reinit_completion(&asd->init_done);
|
asd->delayed_init = ATOMISP_DELAYED_INIT_QUEUED;
|
queue_work(asd->delayed_init_workq,
|
&asd->delayed_init_work);
|
}
|
/*
|
* dequeueing buffers is not needed. CSS will recycle
|
* buffers that it has.
|
*/
|
atomisp_flush_bufs_and_wakeup(asd);
|
|
/* Requeue unprocessed per-frame parameters. */
|
atomisp_recover_params_queue(&asd->video_out_capture);
|
atomisp_recover_params_queue(&asd->video_out_preview);
|
atomisp_recover_params_queue(&asd->video_out_video_capture);
|
|
if ((asd->depth_mode->val) &&
|
(depth_cnt == ATOMISP_DEPTH_SENSOR_STREAMON_COUNT)) {
|
depth_mode = true;
|
continue;
|
}
|
|
ret = v4l2_subdev_call(
|
isp->inputs[asd->input_curr].camera, video,
|
s_stream, 1);
|
if (ret)
|
dev_warn(isp->dev,
|
"can't start streaming on sensor!\n");
|
}
|
|
if (depth_mode) {
|
if (atomisp_stream_on_master_slave_sensor(isp, true))
|
dev_warn(isp->dev,
|
"master slave sensor stream on failed!\n");
|
}
|
}
|
|
void atomisp_wdt_work(struct work_struct *work)
|
{
|
struct atomisp_device *isp = container_of(work, struct atomisp_device,
|
wdt_work);
|
int i;
|
unsigned int pipe_wdt_cnt[MAX_STREAM_NUM][4] = { {0} };
|
bool css_recover = false;
|
|
rt_mutex_lock(&isp->mutex);
|
if (!atomisp_streaming_count(isp)) {
|
atomic_set(&isp->wdt_work_queued, 0);
|
rt_mutex_unlock(&isp->mutex);
|
return;
|
}
|
|
if (!IS_ISP2401) {
|
dev_err(isp->dev, "timeout %d of %d\n",
|
atomic_read(&isp->wdt_count) + 1,
|
ATOMISP_ISP_MAX_TIMEOUT_COUNT);
|
|
if (atomic_inc_return(&isp->wdt_count) < ATOMISP_ISP_MAX_TIMEOUT_COUNT)
|
css_recover = true;
|
} else {
|
css_recover = true;
|
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
|
pipe_wdt_cnt[i][0] +=
|
atomic_read(&asd->video_out_capture.wdt_count);
|
pipe_wdt_cnt[i][1] +=
|
atomic_read(&asd->video_out_vf.wdt_count);
|
pipe_wdt_cnt[i][2] +=
|
atomic_read(&asd->video_out_preview.wdt_count);
|
pipe_wdt_cnt[i][3] +=
|
atomic_read(&asd->video_out_video_capture.wdt_count);
|
css_recover =
|
(pipe_wdt_cnt[i][0] <= ATOMISP_ISP_MAX_TIMEOUT_COUNT &&
|
pipe_wdt_cnt[i][1] <= ATOMISP_ISP_MAX_TIMEOUT_COUNT &&
|
pipe_wdt_cnt[i][2] <= ATOMISP_ISP_MAX_TIMEOUT_COUNT &&
|
pipe_wdt_cnt[i][3] <= ATOMISP_ISP_MAX_TIMEOUT_COUNT)
|
? true : false;
|
dev_err(isp->dev,
|
"pipe on asd%d timeout cnt: (%d, %d, %d, %d) of %d, recover = %d\n",
|
asd->index, pipe_wdt_cnt[i][0], pipe_wdt_cnt[i][1],
|
pipe_wdt_cnt[i][2], pipe_wdt_cnt[i][3],
|
ATOMISP_ISP_MAX_TIMEOUT_COUNT, css_recover);
|
}
|
}
|
|
if (css_recover) {
|
ia_css_debug_dump_sp_sw_debug_info();
|
ia_css_debug_dump_debug_info(__func__);
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED)
|
continue;
|
dev_err(isp->dev, "%s, vdev %s buffers in css: %d\n",
|
__func__,
|
asd->video_out_capture.vdev.name,
|
asd->video_out_capture.
|
buffers_in_css);
|
dev_err(isp->dev,
|
"%s, vdev %s buffers in css: %d\n",
|
__func__,
|
asd->video_out_vf.vdev.name,
|
asd->video_out_vf.
|
buffers_in_css);
|
dev_err(isp->dev,
|
"%s, vdev %s buffers in css: %d\n",
|
__func__,
|
asd->video_out_preview.vdev.name,
|
asd->video_out_preview.
|
buffers_in_css);
|
dev_err(isp->dev,
|
"%s, vdev %s buffers in css: %d\n",
|
__func__,
|
asd->video_out_video_capture.vdev.name,
|
asd->video_out_video_capture.
|
buffers_in_css);
|
dev_err(isp->dev,
|
"%s, s3a buffers in css preview pipe:%d\n",
|
__func__,
|
asd->s3a_bufs_in_css[IA_CSS_PIPE_ID_PREVIEW]);
|
dev_err(isp->dev,
|
"%s, s3a buffers in css capture pipe:%d\n",
|
__func__,
|
asd->s3a_bufs_in_css[IA_CSS_PIPE_ID_CAPTURE]);
|
dev_err(isp->dev,
|
"%s, s3a buffers in css video pipe:%d\n",
|
__func__,
|
asd->s3a_bufs_in_css[IA_CSS_PIPE_ID_VIDEO]);
|
dev_err(isp->dev,
|
"%s, dis buffers in css: %d\n",
|
__func__, asd->dis_bufs_in_css);
|
dev_err(isp->dev,
|
"%s, metadata buffers in css preview pipe:%d\n",
|
__func__,
|
asd->metadata_bufs_in_css
|
[ATOMISP_INPUT_STREAM_GENERAL]
|
[IA_CSS_PIPE_ID_PREVIEW]);
|
dev_err(isp->dev,
|
"%s, metadata buffers in css capture pipe:%d\n",
|
__func__,
|
asd->metadata_bufs_in_css
|
[ATOMISP_INPUT_STREAM_GENERAL]
|
[IA_CSS_PIPE_ID_CAPTURE]);
|
dev_err(isp->dev,
|
"%s, metadata buffers in css video pipe:%d\n",
|
__func__,
|
asd->metadata_bufs_in_css
|
[ATOMISP_INPUT_STREAM_GENERAL]
|
[IA_CSS_PIPE_ID_VIDEO]);
|
if (asd->enable_raw_buffer_lock->val) {
|
unsigned int j;
|
|
dev_err(isp->dev, "%s, raw_buffer_locked_count %d\n",
|
__func__, asd->raw_buffer_locked_count);
|
for (j = 0; j <= ATOMISP_MAX_EXP_ID / 32; j++)
|
dev_err(isp->dev, "%s, raw_buffer_bitmap[%d]: 0x%x\n",
|
__func__, j,
|
asd->raw_buffer_bitmap[j]);
|
}
|
}
|
|
/*sh_css_dump_sp_state();*/
|
/*sh_css_dump_isp_state();*/
|
} else {
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
|
if (asd->streaming ==
|
ATOMISP_DEVICE_STREAMING_ENABLED) {
|
atomisp_clear_css_buffer_counters(asd);
|
atomisp_flush_bufs_and_wakeup(asd);
|
complete(&asd->init_done);
|
}
|
if (IS_ISP2401)
|
atomisp_wdt_stop(asd, false);
|
}
|
|
if (!IS_ISP2401) {
|
atomic_set(&isp->wdt_count, 0);
|
} else {
|
isp->isp_fatal_error = true;
|
atomic_set(&isp->wdt_work_queued, 0);
|
|
rt_mutex_unlock(&isp->mutex);
|
return;
|
}
|
}
|
|
__atomisp_css_recover(isp, true);
|
if (IS_ISP2401) {
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED)
|
continue;
|
|
atomisp_wdt_refresh(asd,
|
isp->sw_contex.file_input ?
|
ATOMISP_ISP_FILE_TIMEOUT_DURATION :
|
ATOMISP_ISP_TIMEOUT_DURATION);
|
}
|
}
|
|
dev_err(isp->dev, "timeout recovery handling done\n");
|
atomic_set(&isp->wdt_work_queued, 0);
|
|
rt_mutex_unlock(&isp->mutex);
|
}
|
|
void atomisp_css_flush(struct atomisp_device *isp)
|
{
|
int i;
|
|
if (!atomisp_streaming_count(isp))
|
return;
|
|
/* Disable wdt */
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
|
atomisp_wdt_stop(asd, true);
|
}
|
|
/* Start recover */
|
__atomisp_css_recover(isp, false);
|
/* Restore wdt */
|
for (i = 0; i < isp->num_of_streams; i++) {
|
struct atomisp_sub_device *asd = &isp->asd[i];
|
|
if (asd->streaming !=
|
ATOMISP_DEVICE_STREAMING_ENABLED)
|
continue;
|
|
atomisp_wdt_refresh(asd,
|
isp->sw_contex.file_input ?
|
ATOMISP_ISP_FILE_TIMEOUT_DURATION :
|
ATOMISP_ISP_TIMEOUT_DURATION);
|
}
|
dev_dbg(isp->dev, "atomisp css flush done\n");
|
}
|
|
void atomisp_wdt(struct timer_list *t)
|
{
|
struct atomisp_sub_device *asd;
|
struct atomisp_device *isp;
|
|
if (!IS_ISP2401) {
|
asd = from_timer(asd, t, wdt);
|
isp = asd->isp;
|
} else {
|
struct atomisp_video_pipe *pipe = from_timer(pipe, t, wdt);
|
|
asd = pipe->asd;
|
isp = asd->isp;
|
|
atomic_inc(&pipe->wdt_count);
|
dev_warn(isp->dev,
|
"[WARNING]asd %d pipe %s ISP timeout %d!\n",
|
asd->index, pipe->vdev.name,
|
atomic_read(&pipe->wdt_count));
|
}
|
|
if (atomic_read(&isp->wdt_work_queued)) {
|
dev_dbg(isp->dev, "ISP watchdog was put into workqueue\n");
|
return;
|
}
|
atomic_set(&isp->wdt_work_queued, 1);
|
queue_work(isp->wdt_work_queue, &isp->wdt_work);
|
}
|
|
/* ISP2400 */
|
void atomisp_wdt_start(struct atomisp_sub_device *asd)
|
{
|
atomisp_wdt_refresh(asd, ATOMISP_ISP_TIMEOUT_DURATION);
|
}
|
|
/* ISP2401 */
|
void atomisp_wdt_refresh_pipe(struct atomisp_video_pipe *pipe,
|
unsigned int delay)
|
{
|
unsigned long next;
|
|
if (!pipe->asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, pipe->vdev.name);
|
return;
|
}
|
|
if (delay != ATOMISP_WDT_KEEP_CURRENT_DELAY)
|
pipe->wdt_duration = delay;
|
|
next = jiffies + pipe->wdt_duration;
|
|
/* Override next if it has been pushed beyon the "next" time */
|
if (atomisp_is_wdt_running(pipe) && time_after(pipe->wdt_expires, next))
|
next = pipe->wdt_expires;
|
|
pipe->wdt_expires = next;
|
|
if (atomisp_is_wdt_running(pipe))
|
dev_dbg(pipe->asd->isp->dev, "WDT will hit after %d ms (%s)\n",
|
((int)(next - jiffies) * 1000 / HZ), pipe->vdev.name);
|
else
|
dev_dbg(pipe->asd->isp->dev, "WDT starts with %d ms period (%s)\n",
|
((int)(next - jiffies) * 1000 / HZ), pipe->vdev.name);
|
|
mod_timer(&pipe->wdt, next);
|
}
|
|
void atomisp_wdt_refresh(struct atomisp_sub_device *asd, unsigned int delay)
|
{
|
if (!IS_ISP2401) {
|
unsigned long next;
|
|
if (delay != ATOMISP_WDT_KEEP_CURRENT_DELAY)
|
asd->wdt_duration = delay;
|
|
next = jiffies + asd->wdt_duration;
|
|
/* Override next if it has been pushed beyon the "next" time */
|
if (atomisp_is_wdt_running(asd) && time_after(asd->wdt_expires, next))
|
next = asd->wdt_expires;
|
|
asd->wdt_expires = next;
|
|
if (atomisp_is_wdt_running(asd))
|
dev_dbg(asd->isp->dev, "WDT will hit after %d ms\n",
|
((int)(next - jiffies) * 1000 / HZ));
|
else
|
dev_dbg(asd->isp->dev, "WDT starts with %d ms period\n",
|
((int)(next - jiffies) * 1000 / HZ));
|
|
mod_timer(&asd->wdt, next);
|
atomic_set(&asd->isp->wdt_count, 0);
|
} else {
|
dev_dbg(asd->isp->dev, "WDT refresh all:\n");
|
if (atomisp_is_wdt_running(&asd->video_out_capture))
|
atomisp_wdt_refresh_pipe(&asd->video_out_capture, delay);
|
if (atomisp_is_wdt_running(&asd->video_out_preview))
|
atomisp_wdt_refresh_pipe(&asd->video_out_preview, delay);
|
if (atomisp_is_wdt_running(&asd->video_out_vf))
|
atomisp_wdt_refresh_pipe(&asd->video_out_vf, delay);
|
if (atomisp_is_wdt_running(&asd->video_out_video_capture))
|
atomisp_wdt_refresh_pipe(&asd->video_out_video_capture, delay);
|
}
|
}
|
|
/* ISP2401 */
|
void atomisp_wdt_stop_pipe(struct atomisp_video_pipe *pipe, bool sync)
|
{
|
if (!pipe->asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, pipe->vdev.name);
|
return;
|
}
|
|
if (!atomisp_is_wdt_running(pipe))
|
return;
|
|
dev_dbg(pipe->asd->isp->dev,
|
"WDT stop asd %d (%s)\n", pipe->asd->index, pipe->vdev.name);
|
|
if (sync) {
|
del_timer_sync(&pipe->wdt);
|
cancel_work_sync(&pipe->asd->isp->wdt_work);
|
} else {
|
del_timer(&pipe->wdt);
|
}
|
}
|
|
/* ISP 2401 */
|
void atomisp_wdt_start_pipe(struct atomisp_video_pipe *pipe)
|
{
|
atomisp_wdt_refresh_pipe(pipe, ATOMISP_ISP_TIMEOUT_DURATION);
|
}
|
|
void atomisp_wdt_stop(struct atomisp_sub_device *asd, bool sync)
|
{
|
dev_dbg(asd->isp->dev, "WDT stop:\n");
|
|
if (!IS_ISP2401) {
|
if (sync) {
|
del_timer_sync(&asd->wdt);
|
cancel_work_sync(&asd->isp->wdt_work);
|
} else {
|
del_timer(&asd->wdt);
|
}
|
} else {
|
atomisp_wdt_stop_pipe(&asd->video_out_capture, sync);
|
atomisp_wdt_stop_pipe(&asd->video_out_preview, sync);
|
atomisp_wdt_stop_pipe(&asd->video_out_vf, sync);
|
atomisp_wdt_stop_pipe(&asd->video_out_video_capture, sync);
|
}
|
}
|
|
void atomisp_setup_flash(struct atomisp_sub_device *asd)
|
{
|
struct atomisp_device *isp = asd->isp;
|
struct v4l2_control ctrl;
|
|
if (!isp->flash)
|
return;
|
|
if (asd->params.flash_state != ATOMISP_FLASH_REQUESTED &&
|
asd->params.flash_state != ATOMISP_FLASH_DONE)
|
return;
|
|
if (asd->params.num_flash_frames) {
|
/* make sure the timeout is set before setting flash mode */
|
ctrl.id = V4L2_CID_FLASH_TIMEOUT;
|
ctrl.value = FLASH_TIMEOUT;
|
|
if (v4l2_s_ctrl(NULL, isp->flash->ctrl_handler, &ctrl)) {
|
dev_err(isp->dev, "flash timeout configure failed\n");
|
return;
|
}
|
|
ia_css_stream_request_flash(asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream);
|
|
asd->params.flash_state = ATOMISP_FLASH_ONGOING;
|
} else {
|
asd->params.flash_state = ATOMISP_FLASH_IDLE;
|
}
|
}
|
|
irqreturn_t atomisp_isr_thread(int irq, void *isp_ptr)
|
{
|
struct atomisp_device *isp = isp_ptr;
|
unsigned long flags;
|
bool frame_done_found[MAX_STREAM_NUM] = {0};
|
bool css_pipe_done[MAX_STREAM_NUM] = {0};
|
unsigned int i;
|
struct atomisp_sub_device *asd;
|
|
dev_dbg(isp->dev, ">%s\n", __func__);
|
|
spin_lock_irqsave(&isp->lock, flags);
|
|
if (!atomisp_streaming_count(isp) && !atomisp_is_acc_enabled(isp)) {
|
spin_unlock_irqrestore(&isp->lock, flags);
|
return IRQ_HANDLED;
|
}
|
|
spin_unlock_irqrestore(&isp->lock, flags);
|
|
/*
|
* The standard CSS2.0 API tells the following calling sequence of
|
* dequeue ready buffers:
|
* while (ia_css_dequeue_event(...)) {
|
* switch (event.type) {
|
* ...
|
* ia_css_pipe_dequeue_buffer()
|
* }
|
* }
|
* That is, dequeue event and buffer are one after another.
|
*
|
* But the following implementation is to first deuque all the event
|
* to a FIFO, then process the event in the FIFO.
|
* This will not have issue in single stream mode, but it do have some
|
* issue in multiple stream case. The issue is that
|
* ia_css_pipe_dequeue_buffer() will not return the corrent buffer in
|
* a specific pipe.
|
*
|
* This is due to ia_css_pipe_dequeue_buffer() does not take the
|
* ia_css_pipe parameter.
|
*
|
* So:
|
* For CSS2.0: we change the way to not dequeue all the event at one
|
* time, instead, dequue one and process one, then another
|
*/
|
rt_mutex_lock(&isp->mutex);
|
if (atomisp_css_isr_thread(isp, frame_done_found, css_pipe_done))
|
goto out;
|
|
for (i = 0; i < isp->num_of_streams; i++) {
|
asd = &isp->asd[i];
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED)
|
continue;
|
atomisp_setup_flash(asd);
|
}
|
out:
|
rt_mutex_unlock(&isp->mutex);
|
for (i = 0; i < isp->num_of_streams; i++) {
|
asd = &isp->asd[i];
|
if (asd->streaming == ATOMISP_DEVICE_STREAMING_ENABLED
|
&& css_pipe_done[asd->index]
|
&& isp->sw_contex.file_input)
|
v4l2_subdev_call(isp->inputs[asd->input_curr].camera,
|
video, s_stream, 1);
|
/* FIXME! FIX ACC implementation */
|
if (asd->acc.pipeline && css_pipe_done[asd->index])
|
atomisp_css_acc_done(asd);
|
}
|
dev_dbg(isp->dev, "<%s\n", __func__);
|
|
return IRQ_HANDLED;
|
}
|
|
/*
|
* utils for buffer allocation/free
|
*/
|
|
int atomisp_get_frame_pgnr(struct atomisp_device *isp,
|
const struct ia_css_frame *frame, u32 *p_pgnr)
|
{
|
if (!frame) {
|
dev_err(isp->dev, "%s: NULL frame pointer ERROR.\n", __func__);
|
return -EINVAL;
|
}
|
|
*p_pgnr = DIV_ROUND_UP(frame->data_bytes, PAGE_SIZE);
|
return 0;
|
}
|
|
/*
|
* Get internal fmt according to V4L2 fmt
|
*/
|
static enum ia_css_frame_format
|
v4l2_fmt_to_sh_fmt(u32 fmt)
|
{
|
switch (fmt) {
|
case V4L2_PIX_FMT_YUV420:
|
return IA_CSS_FRAME_FORMAT_YUV420;
|
case V4L2_PIX_FMT_YVU420:
|
return IA_CSS_FRAME_FORMAT_YV12;
|
case V4L2_PIX_FMT_YUV422P:
|
return IA_CSS_FRAME_FORMAT_YUV422;
|
case V4L2_PIX_FMT_YUV444:
|
return IA_CSS_FRAME_FORMAT_YUV444;
|
case V4L2_PIX_FMT_NV12:
|
return IA_CSS_FRAME_FORMAT_NV12;
|
case V4L2_PIX_FMT_NV21:
|
return IA_CSS_FRAME_FORMAT_NV21;
|
case V4L2_PIX_FMT_NV16:
|
return IA_CSS_FRAME_FORMAT_NV16;
|
case V4L2_PIX_FMT_NV61:
|
return IA_CSS_FRAME_FORMAT_NV61;
|
case V4L2_PIX_FMT_UYVY:
|
return IA_CSS_FRAME_FORMAT_UYVY;
|
case V4L2_PIX_FMT_YUYV:
|
return IA_CSS_FRAME_FORMAT_YUYV;
|
case V4L2_PIX_FMT_RGB24:
|
return IA_CSS_FRAME_FORMAT_PLANAR_RGB888;
|
case V4L2_PIX_FMT_RGB32:
|
return IA_CSS_FRAME_FORMAT_RGBA888;
|
case V4L2_PIX_FMT_RGB565:
|
return IA_CSS_FRAME_FORMAT_RGB565;
|
case V4L2_PIX_FMT_JPEG:
|
case V4L2_PIX_FMT_CUSTOM_M10MO_RAW:
|
return IA_CSS_FRAME_FORMAT_BINARY_8;
|
case V4L2_PIX_FMT_SBGGR16:
|
case V4L2_PIX_FMT_SBGGR10:
|
case V4L2_PIX_FMT_SGBRG10:
|
case V4L2_PIX_FMT_SGRBG10:
|
case V4L2_PIX_FMT_SRGGB10:
|
case V4L2_PIX_FMT_SBGGR12:
|
case V4L2_PIX_FMT_SGBRG12:
|
case V4L2_PIX_FMT_SGRBG12:
|
case V4L2_PIX_FMT_SRGGB12:
|
case V4L2_PIX_FMT_SBGGR8:
|
case V4L2_PIX_FMT_SGBRG8:
|
case V4L2_PIX_FMT_SGRBG8:
|
case V4L2_PIX_FMT_SRGGB8:
|
return IA_CSS_FRAME_FORMAT_RAW;
|
default:
|
return -EINVAL;
|
}
|
}
|
|
/*
|
* raw format match between SH format and V4L2 format
|
*/
|
static int raw_output_format_match_input(u32 input, u32 output)
|
{
|
if ((input == ATOMISP_INPUT_FORMAT_RAW_12) &&
|
((output == V4L2_PIX_FMT_SRGGB12) ||
|
(output == V4L2_PIX_FMT_SGRBG12) ||
|
(output == V4L2_PIX_FMT_SBGGR12) ||
|
(output == V4L2_PIX_FMT_SGBRG12)))
|
return 0;
|
|
if ((input == ATOMISP_INPUT_FORMAT_RAW_10) &&
|
((output == V4L2_PIX_FMT_SRGGB10) ||
|
(output == V4L2_PIX_FMT_SGRBG10) ||
|
(output == V4L2_PIX_FMT_SBGGR10) ||
|
(output == V4L2_PIX_FMT_SGBRG10)))
|
return 0;
|
|
if ((input == ATOMISP_INPUT_FORMAT_RAW_8) &&
|
((output == V4L2_PIX_FMT_SRGGB8) ||
|
(output == V4L2_PIX_FMT_SGRBG8) ||
|
(output == V4L2_PIX_FMT_SBGGR8) ||
|
(output == V4L2_PIX_FMT_SGBRG8)))
|
return 0;
|
|
if ((input == ATOMISP_INPUT_FORMAT_RAW_16) && (output == V4L2_PIX_FMT_SBGGR16))
|
return 0;
|
|
return -EINVAL;
|
}
|
|
static u32 get_pixel_depth(u32 pixelformat)
|
{
|
switch (pixelformat) {
|
case V4L2_PIX_FMT_YUV420:
|
case V4L2_PIX_FMT_NV12:
|
case V4L2_PIX_FMT_NV21:
|
case V4L2_PIX_FMT_YVU420:
|
return 12;
|
case V4L2_PIX_FMT_YUV422P:
|
case V4L2_PIX_FMT_YUYV:
|
case V4L2_PIX_FMT_UYVY:
|
case V4L2_PIX_FMT_NV16:
|
case V4L2_PIX_FMT_NV61:
|
case V4L2_PIX_FMT_RGB565:
|
case V4L2_PIX_FMT_SBGGR16:
|
case V4L2_PIX_FMT_SBGGR12:
|
case V4L2_PIX_FMT_SGBRG12:
|
case V4L2_PIX_FMT_SGRBG12:
|
case V4L2_PIX_FMT_SRGGB12:
|
case V4L2_PIX_FMT_SBGGR10:
|
case V4L2_PIX_FMT_SGBRG10:
|
case V4L2_PIX_FMT_SGRBG10:
|
case V4L2_PIX_FMT_SRGGB10:
|
return 16;
|
case V4L2_PIX_FMT_RGB24:
|
case V4L2_PIX_FMT_YUV444:
|
return 24;
|
case V4L2_PIX_FMT_RGB32:
|
return 32;
|
case V4L2_PIX_FMT_JPEG:
|
case V4L2_PIX_FMT_CUSTOM_M10MO_RAW:
|
case V4L2_PIX_FMT_SBGGR8:
|
case V4L2_PIX_FMT_SGBRG8:
|
case V4L2_PIX_FMT_SGRBG8:
|
case V4L2_PIX_FMT_SRGGB8:
|
return 8;
|
default:
|
return 8 * 2; /* raw type now */
|
}
|
}
|
|
bool atomisp_is_mbuscode_raw(uint32_t code)
|
{
|
return code >= 0x3000 && code < 0x4000;
|
}
|
|
/*
|
* ISP features control function
|
*/
|
|
/*
|
* Set ISP capture mode based on current settings
|
*/
|
static void atomisp_update_capture_mode(struct atomisp_sub_device *asd)
|
{
|
if (asd->params.gdc_cac_en)
|
atomisp_css_capture_set_mode(asd, IA_CSS_CAPTURE_MODE_ADVANCED);
|
else if (asd->params.low_light)
|
atomisp_css_capture_set_mode(asd, IA_CSS_CAPTURE_MODE_LOW_LIGHT);
|
else if (asd->video_out_capture.sh_fmt == IA_CSS_FRAME_FORMAT_RAW)
|
atomisp_css_capture_set_mode(asd, IA_CSS_CAPTURE_MODE_RAW);
|
else
|
atomisp_css_capture_set_mode(asd, IA_CSS_CAPTURE_MODE_PRIMARY);
|
}
|
|
/* ISP2401 */
|
int atomisp_set_sensor_runmode(struct atomisp_sub_device *asd,
|
struct atomisp_s_runmode *runmode)
|
{
|
struct atomisp_device *isp = asd->isp;
|
struct v4l2_ctrl *c;
|
int ret = 0;
|
|
if (!(runmode && (runmode->mode & RUNMODE_MASK)))
|
return -EINVAL;
|
|
mutex_lock(asd->ctrl_handler.lock);
|
c = v4l2_ctrl_find(isp->inputs[asd->input_curr].camera->ctrl_handler,
|
V4L2_CID_RUN_MODE);
|
|
if (c)
|
ret = v4l2_ctrl_s_ctrl(c, runmode->mode);
|
|
mutex_unlock(asd->ctrl_handler.lock);
|
return ret;
|
}
|
|
/*
|
* Function to enable/disable lens geometry distortion correction (GDC) and
|
* chromatic aberration correction (CAC)
|
*/
|
int atomisp_gdc_cac(struct atomisp_sub_device *asd, int flag,
|
__s32 *value)
|
{
|
if (flag == 0) {
|
*value = asd->params.gdc_cac_en;
|
return 0;
|
}
|
|
asd->params.gdc_cac_en = !!*value;
|
if (asd->params.gdc_cac_en) {
|
asd->params.config.morph_table = asd->params.css_param.morph_table;
|
} else {
|
asd->params.config.morph_table = NULL;
|
}
|
asd->params.css_update_params_needed = true;
|
atomisp_update_capture_mode(asd);
|
return 0;
|
}
|
|
/*
|
* Function to enable/disable low light mode including ANR
|
*/
|
int atomisp_low_light(struct atomisp_sub_device *asd, int flag,
|
__s32 *value)
|
{
|
if (flag == 0) {
|
*value = asd->params.low_light;
|
return 0;
|
}
|
|
asd->params.low_light = (*value != 0);
|
atomisp_update_capture_mode(asd);
|
return 0;
|
}
|
|
/*
|
* Function to enable/disable extra noise reduction (XNR) in low light
|
* condition
|
*/
|
int atomisp_xnr(struct atomisp_sub_device *asd, int flag,
|
int *xnr_enable)
|
{
|
if (flag == 0) {
|
*xnr_enable = asd->params.xnr_en;
|
return 0;
|
}
|
|
atomisp_css_capture_enable_xnr(asd, !!*xnr_enable);
|
|
return 0;
|
}
|
|
/*
|
* Function to configure bayer noise reduction
|
*/
|
int atomisp_nr(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_nr_config *arg)
|
{
|
if (flag == 0) {
|
/* Get nr config from current setup */
|
if (atomisp_css_get_nr_config(asd, arg))
|
return -EINVAL;
|
} else {
|
/* Set nr config to isp parameters */
|
memcpy(&asd->params.css_param.nr_config, arg,
|
sizeof(struct ia_css_nr_config));
|
asd->params.config.nr_config = &asd->params.css_param.nr_config;
|
asd->params.css_update_params_needed = true;
|
}
|
return 0;
|
}
|
|
/*
|
* Function to configure temporal noise reduction (TNR)
|
*/
|
int atomisp_tnr(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_tnr_config *config)
|
{
|
/* Get tnr config from current setup */
|
if (flag == 0) {
|
/* Get tnr config from current setup */
|
if (atomisp_css_get_tnr_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set tnr config to isp parameters */
|
memcpy(&asd->params.css_param.tnr_config, config,
|
sizeof(struct ia_css_tnr_config));
|
asd->params.config.tnr_config = &asd->params.css_param.tnr_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to configure black level compensation
|
*/
|
int atomisp_black_level(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_ob_config *config)
|
{
|
if (flag == 0) {
|
/* Get ob config from current setup */
|
if (atomisp_css_get_ob_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set ob config to isp parameters */
|
memcpy(&asd->params.css_param.ob_config, config,
|
sizeof(struct ia_css_ob_config));
|
asd->params.config.ob_config = &asd->params.css_param.ob_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to configure edge enhancement
|
*/
|
int atomisp_ee(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_ee_config *config)
|
{
|
if (flag == 0) {
|
/* Get ee config from current setup */
|
if (atomisp_css_get_ee_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set ee config to isp parameters */
|
memcpy(&asd->params.css_param.ee_config, config,
|
sizeof(asd->params.css_param.ee_config));
|
asd->params.config.ee_config = &asd->params.css_param.ee_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to update Gamma table for gamma, brightness and contrast config
|
*/
|
int atomisp_gamma(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_gamma_table *config)
|
{
|
if (flag == 0) {
|
/* Get gamma table from current setup */
|
if (atomisp_css_get_gamma_table(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set gamma table to isp parameters */
|
memcpy(&asd->params.css_param.gamma_table, config,
|
sizeof(asd->params.css_param.gamma_table));
|
asd->params.config.gamma_table = &asd->params.css_param.gamma_table;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to update Ctc table for Chroma Enhancement
|
*/
|
int atomisp_ctc(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_ctc_table *config)
|
{
|
if (flag == 0) {
|
/* Get ctc table from current setup */
|
if (atomisp_css_get_ctc_table(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set ctc table to isp parameters */
|
memcpy(&asd->params.css_param.ctc_table, config,
|
sizeof(asd->params.css_param.ctc_table));
|
atomisp_css_set_ctc_table(asd, &asd->params.css_param.ctc_table);
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to update gamma correction parameters
|
*/
|
int atomisp_gamma_correction(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_gc_config *config)
|
{
|
if (flag == 0) {
|
/* Get gamma correction params from current setup */
|
if (atomisp_css_get_gc_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set gamma correction params to isp parameters */
|
memcpy(&asd->params.css_param.gc_config, config,
|
sizeof(asd->params.css_param.gc_config));
|
asd->params.config.gc_config = &asd->params.css_param.gc_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to update narrow gamma flag
|
*/
|
int atomisp_formats(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_formats_config *config)
|
{
|
if (flag == 0) {
|
/* Get narrow gamma flag from current setup */
|
if (atomisp_css_get_formats_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set narrow gamma flag to isp parameters */
|
memcpy(&asd->params.css_param.formats_config, config,
|
sizeof(asd->params.css_param.formats_config));
|
asd->params.config.formats_config = &asd->params.css_param.formats_config;
|
}
|
|
return 0;
|
}
|
|
void atomisp_free_internal_buffers(struct atomisp_sub_device *asd)
|
{
|
atomisp_free_css_parameters(&asd->params.css_param);
|
|
if (asd->raw_output_frame) {
|
ia_css_frame_free(asd->raw_output_frame);
|
asd->raw_output_frame = NULL;
|
}
|
}
|
|
static void atomisp_update_grid_info(struct atomisp_sub_device *asd,
|
enum ia_css_pipe_id pipe_id,
|
int source_pad)
|
{
|
struct atomisp_device *isp = asd->isp;
|
int err;
|
u16 stream_id = atomisp_source_pad_to_stream_id(asd, source_pad);
|
|
if (atomisp_css_get_grid_info(asd, pipe_id, source_pad))
|
return;
|
|
/* We must free all buffers because they no longer match
|
the grid size. */
|
atomisp_css_free_stat_buffers(asd);
|
|
err = atomisp_alloc_css_stat_bufs(asd, stream_id);
|
if (err) {
|
dev_err(isp->dev, "stat_buf allocate error\n");
|
goto err;
|
}
|
|
if (atomisp_alloc_3a_output_buf(asd)) {
|
/* Failure for 3A buffers does not influence DIS buffers */
|
if (asd->params.s3a_output_bytes != 0) {
|
/* For SOC sensor happens s3a_output_bytes == 0,
|
* using if condition to exclude false error log */
|
dev_err(isp->dev, "Failed to allocate memory for 3A statistics\n");
|
}
|
goto err;
|
}
|
|
if (atomisp_alloc_dis_coef_buf(asd)) {
|
dev_err(isp->dev,
|
"Failed to allocate memory for DIS statistics\n");
|
goto err;
|
}
|
|
if (atomisp_alloc_metadata_output_buf(asd)) {
|
dev_err(isp->dev, "Failed to allocate memory for metadata\n");
|
goto err;
|
}
|
|
return;
|
|
err:
|
atomisp_css_free_stat_buffers(asd);
|
return;
|
}
|
|
static void atomisp_curr_user_grid_info(struct atomisp_sub_device *asd,
|
struct atomisp_grid_info *info)
|
{
|
memcpy(info, &asd->params.curr_grid_info.s3a_grid,
|
sizeof(struct ia_css_3a_grid_info));
|
}
|
|
int atomisp_compare_grid(struct atomisp_sub_device *asd,
|
struct atomisp_grid_info *atomgrid)
|
{
|
struct atomisp_grid_info tmp = {0};
|
|
atomisp_curr_user_grid_info(asd, &tmp);
|
return memcmp(atomgrid, &tmp, sizeof(tmp));
|
}
|
|
/*
|
* Function to update Gdc table for gdc
|
*/
|
int atomisp_gdc_cac_table(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_morph_table *config)
|
{
|
int ret;
|
int i;
|
struct atomisp_device *isp = asd->isp;
|
|
if (flag == 0) {
|
/* Get gdc table from current setup */
|
struct ia_css_morph_table tab = {0};
|
|
atomisp_css_get_morph_table(asd, &tab);
|
|
config->width = tab.width;
|
config->height = tab.height;
|
|
for (i = 0; i < IA_CSS_MORPH_TABLE_NUM_PLANES; i++) {
|
ret = copy_to_user(config->coordinates_x[i],
|
tab.coordinates_x[i], tab.height *
|
tab.width * sizeof(*tab.coordinates_x[i]));
|
if (ret) {
|
dev_err(isp->dev,
|
"Failed to copy to User for x\n");
|
return -EFAULT;
|
}
|
ret = copy_to_user(config->coordinates_y[i],
|
tab.coordinates_y[i], tab.height *
|
tab.width * sizeof(*tab.coordinates_y[i]));
|
if (ret) {
|
dev_err(isp->dev,
|
"Failed to copy to User for y\n");
|
return -EFAULT;
|
}
|
}
|
} else {
|
struct ia_css_morph_table *tab =
|
asd->params.css_param.morph_table;
|
|
/* free first if we have one */
|
if (tab) {
|
atomisp_css_morph_table_free(tab);
|
asd->params.css_param.morph_table = NULL;
|
}
|
|
/* allocate new one */
|
tab = atomisp_css_morph_table_allocate(config->width,
|
config->height);
|
|
if (!tab) {
|
dev_err(isp->dev, "out of memory\n");
|
return -EINVAL;
|
}
|
|
for (i = 0; i < IA_CSS_MORPH_TABLE_NUM_PLANES; i++) {
|
ret = copy_from_user(tab->coordinates_x[i],
|
config->coordinates_x[i],
|
config->height * config->width *
|
sizeof(*config->coordinates_x[i]));
|
if (ret) {
|
dev_err(isp->dev,
|
"Failed to copy from User for x, ret %d\n",
|
ret);
|
atomisp_css_morph_table_free(tab);
|
return -EFAULT;
|
}
|
ret = copy_from_user(tab->coordinates_y[i],
|
config->coordinates_y[i],
|
config->height * config->width *
|
sizeof(*config->coordinates_y[i]));
|
if (ret) {
|
dev_err(isp->dev,
|
"Failed to copy from User for y, ret is %d\n",
|
ret);
|
atomisp_css_morph_table_free(tab);
|
return -EFAULT;
|
}
|
}
|
asd->params.css_param.morph_table = tab;
|
if (asd->params.gdc_cac_en)
|
asd->params.config.morph_table = tab;
|
}
|
|
return 0;
|
}
|
|
int atomisp_macc_table(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_macc_config *config)
|
{
|
struct ia_css_macc_table *macc_table;
|
|
switch (config->color_effect) {
|
case V4L2_COLORFX_NONE:
|
macc_table = &asd->params.css_param.macc_table;
|
break;
|
case V4L2_COLORFX_SKY_BLUE:
|
macc_table = &blue_macc_table;
|
break;
|
case V4L2_COLORFX_GRASS_GREEN:
|
macc_table = &green_macc_table;
|
break;
|
case V4L2_COLORFX_SKIN_WHITEN_LOW:
|
macc_table = &skin_low_macc_table;
|
break;
|
case V4L2_COLORFX_SKIN_WHITEN:
|
macc_table = &skin_medium_macc_table;
|
break;
|
case V4L2_COLORFX_SKIN_WHITEN_HIGH:
|
macc_table = &skin_high_macc_table;
|
break;
|
default:
|
return -EINVAL;
|
}
|
|
if (flag == 0) {
|
/* Get macc table from current setup */
|
memcpy(&config->table, macc_table,
|
sizeof(struct ia_css_macc_table));
|
} else {
|
memcpy(macc_table, &config->table,
|
sizeof(struct ia_css_macc_table));
|
if (config->color_effect == asd->params.color_effect)
|
asd->params.config.macc_table = macc_table;
|
}
|
|
return 0;
|
}
|
|
int atomisp_set_dis_vector(struct atomisp_sub_device *asd,
|
struct atomisp_dis_vector *vector)
|
{
|
atomisp_css_video_set_dis_vector(asd, vector);
|
|
asd->params.dis_proj_data_valid = false;
|
asd->params.css_update_params_needed = true;
|
return 0;
|
}
|
|
/*
|
* Function to set/get image stablization statistics
|
*/
|
int atomisp_get_dis_stat(struct atomisp_sub_device *asd,
|
struct atomisp_dis_statistics *stats)
|
{
|
return atomisp_css_get_dis_stat(asd, stats);
|
}
|
|
/*
|
* Function set camrea_prefiles.xml current sensor pixel array size
|
*/
|
int atomisp_set_array_res(struct atomisp_sub_device *asd,
|
struct atomisp_resolution *config)
|
{
|
dev_dbg(asd->isp->dev, ">%s start\n", __func__);
|
if (!config) {
|
dev_err(asd->isp->dev, "Set sensor array size is not valid\n");
|
return -EINVAL;
|
}
|
|
asd->sensor_array_res.width = config->width;
|
asd->sensor_array_res.height = config->height;
|
return 0;
|
}
|
|
/*
|
* Function to get DVS2 BQ resolution settings
|
*/
|
int atomisp_get_dvs2_bq_resolutions(struct atomisp_sub_device *asd,
|
struct atomisp_dvs2_bq_resolutions *bq_res)
|
{
|
struct ia_css_pipe_config *pipe_cfg = NULL;
|
struct ia_css_stream_config *stream_cfg = NULL;
|
struct ia_css_stream_input_config *input_config = NULL;
|
|
struct ia_css_stream *stream =
|
asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream;
|
if (!stream) {
|
dev_warn(asd->isp->dev, "stream is not created");
|
return -EAGAIN;
|
}
|
|
pipe_cfg = &asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL]
|
.pipe_configs[IA_CSS_PIPE_ID_VIDEO];
|
stream_cfg = &asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL]
|
.stream_config;
|
input_config = &stream_cfg->input_config;
|
|
if (!bq_res)
|
return -EINVAL;
|
|
/* the GDC output resolution */
|
bq_res->output_bq.width_bq = pipe_cfg->output_info[0].res.width / 2;
|
bq_res->output_bq.height_bq = pipe_cfg->output_info[0].res.height / 2;
|
|
bq_res->envelope_bq.width_bq = 0;
|
bq_res->envelope_bq.height_bq = 0;
|
/* the GDC input resolution */
|
if (!asd->continuous_mode->val) {
|
bq_res->source_bq.width_bq = bq_res->output_bq.width_bq +
|
pipe_cfg->dvs_envelope.width / 2;
|
bq_res->source_bq.height_bq = bq_res->output_bq.height_bq +
|
pipe_cfg->dvs_envelope.height / 2;
|
/*
|
* Bad pixels caused by spatial filter processing
|
* ISP filter resolution should be given by CSS/FW, but for now
|
* there is not such API to query, and it is fixed value, so
|
* hardcoded here.
|
*/
|
bq_res->ispfilter_bq.width_bq = 12 / 2;
|
bq_res->ispfilter_bq.height_bq = 12 / 2;
|
/* spatial filter shift, always 4 pixels */
|
bq_res->gdc_shift_bq.width_bq = 4 / 2;
|
bq_res->gdc_shift_bq.height_bq = 4 / 2;
|
|
if (asd->params.video_dis_en) {
|
bq_res->envelope_bq.width_bq = pipe_cfg->dvs_envelope.width
|
/ 2 - bq_res->ispfilter_bq.width_bq;
|
bq_res->envelope_bq.height_bq = pipe_cfg->dvs_envelope.height
|
/ 2 - bq_res->ispfilter_bq.height_bq;
|
}
|
} else {
|
unsigned int w_padding;
|
unsigned int gdc_effective_input = 0;
|
|
/* For GDC:
|
* gdc_effective_input = effective_input + envelope
|
*
|
* From the comment and formula in BZ1786,
|
* we see the source_bq should be:
|
* effective_input / bayer_ds_ratio
|
*/
|
bq_res->source_bq.width_bq =
|
(input_config->effective_res.width *
|
pipe_cfg->bayer_ds_out_res.width /
|
input_config->effective_res.width + 1) / 2;
|
bq_res->source_bq.height_bq =
|
(input_config->effective_res.height *
|
pipe_cfg->bayer_ds_out_res.height /
|
input_config->effective_res.height + 1) / 2;
|
|
if (!asd->params.video_dis_en) {
|
/*
|
* We adjust the ispfilter_bq to:
|
* ispfilter_bq = 128/BDS
|
* we still need firmware team to provide an offical
|
* formula for SDV.
|
*/
|
bq_res->ispfilter_bq.width_bq = 128 *
|
pipe_cfg->bayer_ds_out_res.width /
|
input_config->effective_res.width / 2;
|
bq_res->ispfilter_bq.height_bq = 128 *
|
pipe_cfg->bayer_ds_out_res.width /
|
input_config->effective_res.width / 2;
|
|
if (IS_HWREVISION(asd->isp, ATOMISP_HW_REVISION_ISP2401)) {
|
/* No additional left padding for ISYS2401 */
|
bq_res->gdc_shift_bq.width_bq = 4 / 2;
|
bq_res->gdc_shift_bq.height_bq = 4 / 2;
|
} else {
|
/*
|
* For the w_padding and gdc_shift_bq cacluation
|
* Please see the BZ 1786 and 4358 for more info.
|
* Just test that this formula can work now,
|
* but we still have no offical formula.
|
*
|
* w_padding = ceiling(gdc_effective_input
|
* /128, 1) * 128 - effective_width
|
* gdc_shift_bq = w_padding/BDS/2 + ispfilter_bq/2
|
*/
|
gdc_effective_input =
|
input_config->effective_res.width +
|
pipe_cfg->dvs_envelope.width;
|
w_padding = roundup(gdc_effective_input, 128) -
|
input_config->effective_res.width;
|
w_padding = w_padding *
|
pipe_cfg->bayer_ds_out_res.width /
|
input_config->effective_res.width + 1;
|
w_padding = roundup(w_padding / 2, 1);
|
|
bq_res->gdc_shift_bq.width_bq = bq_res->ispfilter_bq.width_bq / 2
|
+ w_padding;
|
bq_res->gdc_shift_bq.height_bq = 4 / 2;
|
}
|
} else {
|
unsigned int dvs_w, dvs_h, dvs_w_max, dvs_h_max;
|
|
bq_res->ispfilter_bq.width_bq = 8 / 2;
|
bq_res->ispfilter_bq.height_bq = 8 / 2;
|
|
if (IS_HWREVISION(asd->isp, ATOMISP_HW_REVISION_ISP2401)) {
|
/* No additional left padding for ISYS2401 */
|
bq_res->gdc_shift_bq.width_bq = 4 / 2;
|
bq_res->gdc_shift_bq.height_bq = 4 / 2;
|
} else {
|
w_padding =
|
roundup(input_config->effective_res.width, 128) -
|
input_config->effective_res.width;
|
if (w_padding < 12)
|
w_padding = 12;
|
bq_res->gdc_shift_bq.width_bq = 4 / 2 +
|
((w_padding - 12) *
|
pipe_cfg->bayer_ds_out_res.width /
|
input_config->effective_res.width + 1) / 2;
|
bq_res->gdc_shift_bq.height_bq = 4 / 2;
|
}
|
|
dvs_w = pipe_cfg->bayer_ds_out_res.width -
|
pipe_cfg->output_info[0].res.width;
|
dvs_h = pipe_cfg->bayer_ds_out_res.height -
|
pipe_cfg->output_info[0].res.height;
|
dvs_w_max = rounddown(
|
pipe_cfg->output_info[0].res.width / 5,
|
ATOM_ISP_STEP_WIDTH);
|
dvs_h_max = rounddown(
|
pipe_cfg->output_info[0].res.height / 5,
|
ATOM_ISP_STEP_HEIGHT);
|
bq_res->envelope_bq.width_bq =
|
min((dvs_w / 2), (dvs_w_max / 2)) -
|
bq_res->ispfilter_bq.width_bq;
|
bq_res->envelope_bq.height_bq =
|
min((dvs_h / 2), (dvs_h_max / 2)) -
|
bq_res->ispfilter_bq.height_bq;
|
}
|
}
|
|
dev_dbg(asd->isp->dev,
|
"source_bq.width_bq %d, source_bq.height_bq %d,\nispfilter_bq.width_bq %d, ispfilter_bq.height_bq %d,\ngdc_shift_bq.width_bq %d, gdc_shift_bq.height_bq %d,\nenvelope_bq.width_bq %d, envelope_bq.height_bq %d,\noutput_bq.width_bq %d, output_bq.height_bq %d\n",
|
bq_res->source_bq.width_bq, bq_res->source_bq.height_bq,
|
bq_res->ispfilter_bq.width_bq, bq_res->ispfilter_bq.height_bq,
|
bq_res->gdc_shift_bq.width_bq, bq_res->gdc_shift_bq.height_bq,
|
bq_res->envelope_bq.width_bq, bq_res->envelope_bq.height_bq,
|
bq_res->output_bq.width_bq, bq_res->output_bq.height_bq);
|
|
return 0;
|
}
|
|
int atomisp_set_dis_coefs(struct atomisp_sub_device *asd,
|
struct atomisp_dis_coefficients *coefs)
|
{
|
return atomisp_css_set_dis_coefs(asd, coefs);
|
}
|
|
/*
|
* Function to set/get 3A stat from isp
|
*/
|
int atomisp_3a_stat(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_3a_statistics *config)
|
{
|
struct atomisp_device *isp = asd->isp;
|
struct atomisp_s3a_buf *s3a_buf;
|
unsigned long ret;
|
|
if (flag != 0)
|
return -EINVAL;
|
|
/* sanity check to avoid writing into unallocated memory. */
|
if (asd->params.s3a_output_bytes == 0)
|
return -EINVAL;
|
|
if (atomisp_compare_grid(asd, &config->grid_info) != 0) {
|
/* If the grid info in the argument differs from the current
|
grid info, we tell the caller to reset the grid size and
|
try again. */
|
return -EAGAIN;
|
}
|
|
if (list_empty(&asd->s3a_stats_ready)) {
|
dev_err(isp->dev, "3a statistics is not valid.\n");
|
return -EAGAIN;
|
}
|
|
s3a_buf = list_entry(asd->s3a_stats_ready.next,
|
struct atomisp_s3a_buf, list);
|
if (s3a_buf->s3a_map)
|
ia_css_translate_3a_statistics(
|
asd->params.s3a_user_stat, s3a_buf->s3a_map);
|
else
|
ia_css_get_3a_statistics(asd->params.s3a_user_stat,
|
s3a_buf->s3a_data);
|
|
config->exp_id = s3a_buf->s3a_data->exp_id;
|
config->isp_config_id = s3a_buf->s3a_data->isp_config_id;
|
|
ret = copy_to_user(config->data, asd->params.s3a_user_stat->data,
|
asd->params.s3a_output_bytes);
|
if (ret) {
|
dev_err(isp->dev, "copy to user failed: copied %lu bytes\n",
|
ret);
|
return -EFAULT;
|
}
|
|
/* Move to free buffer list */
|
list_del_init(&s3a_buf->list);
|
list_add_tail(&s3a_buf->list, &asd->s3a_stats);
|
dev_dbg(isp->dev, "%s: finish getting exp_id %d 3a stat, isp_config_id %d\n",
|
__func__,
|
config->exp_id, config->isp_config_id);
|
return 0;
|
}
|
|
int atomisp_get_metadata(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_metadata *md)
|
{
|
struct atomisp_device *isp = asd->isp;
|
struct ia_css_stream_info *stream_info;
|
struct camera_mipi_info *mipi_info;
|
struct atomisp_metadata_buf *md_buf;
|
enum atomisp_metadata_type md_type = ATOMISP_MAIN_METADATA;
|
int ret, i;
|
|
if (flag != 0)
|
return -EINVAL;
|
|
stream_info = &asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].
|
stream_info;
|
|
/* We always return the resolution and stride even if there is
|
* no valid metadata. This allows the caller to get the information
|
* needed to allocate user-space buffers. */
|
md->width = stream_info->metadata_info.resolution.width;
|
md->height = stream_info->metadata_info.resolution.height;
|
md->stride = stream_info->metadata_info.stride;
|
|
/* sanity check to avoid writing into unallocated memory.
|
* This does not return an error because it is a valid way
|
* for applications to detect that metadata is not enabled. */
|
if (md->width == 0 || md->height == 0 || !md->data)
|
return 0;
|
|
/* This is done in the atomisp_buf_done() */
|
if (list_empty(&asd->metadata_ready[md_type])) {
|
dev_warn(isp->dev, "Metadata queue is empty now!\n");
|
return -EAGAIN;
|
}
|
|
mipi_info = atomisp_to_sensor_mipi_info(
|
isp->inputs[asd->input_curr].camera);
|
if (!mipi_info)
|
return -EINVAL;
|
|
if (mipi_info->metadata_effective_width) {
|
for (i = 0; i < md->height; i++)
|
md->effective_width[i] =
|
mipi_info->metadata_effective_width[i];
|
}
|
|
md_buf = list_entry(asd->metadata_ready[md_type].next,
|
struct atomisp_metadata_buf, list);
|
md->exp_id = md_buf->metadata->exp_id;
|
if (md_buf->md_vptr) {
|
ret = copy_to_user(md->data,
|
md_buf->md_vptr,
|
stream_info->metadata_info.size);
|
} else {
|
hmm_load(md_buf->metadata->address,
|
asd->params.metadata_user[md_type],
|
stream_info->metadata_info.size);
|
|
ret = copy_to_user(md->data,
|
asd->params.metadata_user[md_type],
|
stream_info->metadata_info.size);
|
}
|
if (ret) {
|
dev_err(isp->dev, "copy to user failed: copied %d bytes\n",
|
ret);
|
return -EFAULT;
|
}
|
|
list_del_init(&md_buf->list);
|
list_add_tail(&md_buf->list, &asd->metadata[md_type]);
|
|
dev_dbg(isp->dev, "%s: HAL de-queued metadata type %d with exp_id %d\n",
|
__func__, md_type, md->exp_id);
|
return 0;
|
}
|
|
int atomisp_get_metadata_by_type(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_metadata_with_type *md)
|
{
|
struct atomisp_device *isp = asd->isp;
|
struct ia_css_stream_info *stream_info;
|
struct camera_mipi_info *mipi_info;
|
struct atomisp_metadata_buf *md_buf;
|
enum atomisp_metadata_type md_type;
|
int ret, i;
|
|
if (flag != 0)
|
return -EINVAL;
|
|
stream_info = &asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].
|
stream_info;
|
|
/* We always return the resolution and stride even if there is
|
* no valid metadata. This allows the caller to get the information
|
* needed to allocate user-space buffers. */
|
md->width = stream_info->metadata_info.resolution.width;
|
md->height = stream_info->metadata_info.resolution.height;
|
md->stride = stream_info->metadata_info.stride;
|
|
/* sanity check to avoid writing into unallocated memory.
|
* This does not return an error because it is a valid way
|
* for applications to detect that metadata is not enabled. */
|
if (md->width == 0 || md->height == 0 || !md->data)
|
return 0;
|
|
md_type = md->type;
|
if (md_type < 0 || md_type >= ATOMISP_METADATA_TYPE_NUM)
|
return -EINVAL;
|
|
/* This is done in the atomisp_buf_done() */
|
if (list_empty(&asd->metadata_ready[md_type])) {
|
dev_warn(isp->dev, "Metadata queue is empty now!\n");
|
return -EAGAIN;
|
}
|
|
mipi_info = atomisp_to_sensor_mipi_info(
|
isp->inputs[asd->input_curr].camera);
|
if (!mipi_info)
|
return -EINVAL;
|
|
if (mipi_info->metadata_effective_width) {
|
for (i = 0; i < md->height; i++)
|
md->effective_width[i] =
|
mipi_info->metadata_effective_width[i];
|
}
|
|
md_buf = list_entry(asd->metadata_ready[md_type].next,
|
struct atomisp_metadata_buf, list);
|
md->exp_id = md_buf->metadata->exp_id;
|
if (md_buf->md_vptr) {
|
ret = copy_to_user(md->data,
|
md_buf->md_vptr,
|
stream_info->metadata_info.size);
|
} else {
|
hmm_load(md_buf->metadata->address,
|
asd->params.metadata_user[md_type],
|
stream_info->metadata_info.size);
|
|
ret = copy_to_user(md->data,
|
asd->params.metadata_user[md_type],
|
stream_info->metadata_info.size);
|
}
|
if (ret) {
|
dev_err(isp->dev, "copy to user failed: copied %d bytes\n",
|
ret);
|
return -EFAULT;
|
} else {
|
list_del_init(&md_buf->list);
|
list_add_tail(&md_buf->list, &asd->metadata[md_type]);
|
}
|
dev_dbg(isp->dev, "%s: HAL de-queued metadata type %d with exp_id %d\n",
|
__func__, md_type, md->exp_id);
|
return 0;
|
}
|
|
/*
|
* Function to calculate real zoom region for every pipe
|
*/
|
int atomisp_calculate_real_zoom_region(struct atomisp_sub_device *asd,
|
struct ia_css_dz_config *dz_config,
|
enum ia_css_pipe_id css_pipe_id)
|
|
{
|
struct atomisp_stream_env *stream_env =
|
&asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL];
|
struct atomisp_resolution eff_res, out_res;
|
int w_offset, h_offset;
|
|
memset(&eff_res, 0, sizeof(eff_res));
|
memset(&out_res, 0, sizeof(out_res));
|
|
if (dz_config->dx || dz_config->dy)
|
return 0;
|
|
if (css_pipe_id != IA_CSS_PIPE_ID_PREVIEW
|
&& css_pipe_id != IA_CSS_PIPE_ID_CAPTURE) {
|
dev_err(asd->isp->dev, "%s the set pipe no support crop region"
|
, __func__);
|
return -EINVAL;
|
}
|
|
eff_res.width =
|
stream_env->stream_config.input_config.effective_res.width;
|
eff_res.height =
|
stream_env->stream_config.input_config.effective_res.height;
|
if (eff_res.width == 0 || eff_res.height == 0) {
|
dev_err(asd->isp->dev, "%s err effective resolution"
|
, __func__);
|
return -EINVAL;
|
}
|
|
if (dz_config->zoom_region.resolution.width
|
== asd->sensor_array_res.width
|
|| dz_config->zoom_region.resolution.height
|
== asd->sensor_array_res.height) {
|
/*no need crop region*/
|
dz_config->zoom_region.origin.x = 0;
|
dz_config->zoom_region.origin.y = 0;
|
dz_config->zoom_region.resolution.width = eff_res.width;
|
dz_config->zoom_region.resolution.height = eff_res.height;
|
return 0;
|
}
|
|
/* FIXME:
|
* This is not the correct implementation with Google's definition, due
|
* to firmware limitation.
|
* map real crop region base on above calculating base max crop region.
|
*/
|
|
if (!IS_ISP2401) {
|
dz_config->zoom_region.origin.x = dz_config->zoom_region.origin.x
|
* eff_res.width
|
/ asd->sensor_array_res.width;
|
dz_config->zoom_region.origin.y = dz_config->zoom_region.origin.y
|
* eff_res.height
|
/ asd->sensor_array_res.height;
|
dz_config->zoom_region.resolution.width = dz_config->zoom_region.resolution.width
|
* eff_res.width
|
/ asd->sensor_array_res.width;
|
dz_config->zoom_region.resolution.height = dz_config->zoom_region.resolution.height
|
* eff_res.height
|
/ asd->sensor_array_res.height;
|
/*
|
* Set same ratio of crop region resolution and current pipe output
|
* resolution
|
*/
|
out_res.width = stream_env->pipe_configs[css_pipe_id].output_info[0].res.width;
|
out_res.height = stream_env->pipe_configs[css_pipe_id].output_info[0].res.height;
|
if (out_res.width == 0 || out_res.height == 0) {
|
dev_err(asd->isp->dev, "%s err current pipe output resolution"
|
, __func__);
|
return -EINVAL;
|
}
|
} else {
|
out_res.width = stream_env->pipe_configs[css_pipe_id].output_info[0].res.width;
|
out_res.height = stream_env->pipe_configs[css_pipe_id].output_info[0].res.height;
|
if (out_res.width == 0 || out_res.height == 0) {
|
dev_err(asd->isp->dev, "%s err current pipe output resolution"
|
, __func__);
|
return -EINVAL;
|
}
|
|
if (asd->sensor_array_res.width * out_res.height
|
< out_res.width * asd->sensor_array_res.height) {
|
h_offset = asd->sensor_array_res.height
|
- asd->sensor_array_res.width
|
* out_res.height / out_res.width;
|
h_offset = h_offset / 2;
|
if (dz_config->zoom_region.origin.y < h_offset)
|
dz_config->zoom_region.origin.y = 0;
|
else
|
dz_config->zoom_region.origin.y = dz_config->zoom_region.origin.y - h_offset;
|
w_offset = 0;
|
} else {
|
w_offset = asd->sensor_array_res.width
|
- asd->sensor_array_res.height
|
* out_res.width / out_res.height;
|
w_offset = w_offset / 2;
|
if (dz_config->zoom_region.origin.x < w_offset)
|
dz_config->zoom_region.origin.x = 0;
|
else
|
dz_config->zoom_region.origin.x = dz_config->zoom_region.origin.x - w_offset;
|
h_offset = 0;
|
}
|
dz_config->zoom_region.origin.x = dz_config->zoom_region.origin.x
|
* eff_res.width
|
/ (asd->sensor_array_res.width - 2 * w_offset);
|
dz_config->zoom_region.origin.y = dz_config->zoom_region.origin.y
|
* eff_res.height
|
/ (asd->sensor_array_res.height - 2 * h_offset);
|
dz_config->zoom_region.resolution.width = dz_config->zoom_region.resolution.width
|
* eff_res.width
|
/ (asd->sensor_array_res.width - 2 * w_offset);
|
dz_config->zoom_region.resolution.height = dz_config->zoom_region.resolution.height
|
* eff_res.height
|
/ (asd->sensor_array_res.height - 2 * h_offset);
|
}
|
|
if (out_res.width * dz_config->zoom_region.resolution.height
|
> dz_config->zoom_region.resolution.width * out_res.height) {
|
dz_config->zoom_region.resolution.height =
|
dz_config->zoom_region.resolution.width
|
* out_res.height / out_res.width;
|
} else {
|
dz_config->zoom_region.resolution.width =
|
dz_config->zoom_region.resolution.height
|
* out_res.width / out_res.height;
|
}
|
dev_dbg(asd->isp->dev,
|
"%s crop region:(%d,%d),(%d,%d) eff_res(%d, %d) array_size(%d,%d) out_res(%d, %d)\n",
|
__func__, dz_config->zoom_region.origin.x,
|
dz_config->zoom_region.origin.y,
|
dz_config->zoom_region.resolution.width,
|
dz_config->zoom_region.resolution.height,
|
eff_res.width, eff_res.height,
|
asd->sensor_array_res.width,
|
asd->sensor_array_res.height,
|
out_res.width, out_res.height);
|
|
if ((dz_config->zoom_region.origin.x +
|
dz_config->zoom_region.resolution.width
|
> eff_res.width) ||
|
(dz_config->zoom_region.origin.y +
|
dz_config->zoom_region.resolution.height
|
> eff_res.height))
|
return -EINVAL;
|
|
return 0;
|
}
|
|
/*
|
* Function to check the zoom region whether is effective
|
*/
|
static bool atomisp_check_zoom_region(
|
struct atomisp_sub_device *asd,
|
struct ia_css_dz_config *dz_config)
|
{
|
struct atomisp_resolution config;
|
bool flag = false;
|
unsigned int w, h;
|
|
memset(&config, 0, sizeof(struct atomisp_resolution));
|
|
if (dz_config->dx && dz_config->dy)
|
return true;
|
|
config.width = asd->sensor_array_res.width;
|
config.height = asd->sensor_array_res.height;
|
w = dz_config->zoom_region.origin.x +
|
dz_config->zoom_region.resolution.width;
|
h = dz_config->zoom_region.origin.y +
|
dz_config->zoom_region.resolution.height;
|
|
if ((w <= config.width) && (h <= config.height) && w > 0 && h > 0)
|
flag = true;
|
else
|
/* setting error zoom region */
|
dev_err(asd->isp->dev,
|
"%s zoom region ERROR:dz_config:(%d,%d),(%d,%d)array_res(%d, %d)\n",
|
__func__, dz_config->zoom_region.origin.x,
|
dz_config->zoom_region.origin.y,
|
dz_config->zoom_region.resolution.width,
|
dz_config->zoom_region.resolution.height,
|
config.width, config.height);
|
|
return flag;
|
}
|
|
void atomisp_apply_css_parameters(
|
struct atomisp_sub_device *asd,
|
struct atomisp_css_params *css_param)
|
{
|
if (css_param->update_flag.wb_config)
|
asd->params.config.wb_config = &css_param->wb_config;
|
|
if (css_param->update_flag.ob_config)
|
asd->params.config.ob_config = &css_param->ob_config;
|
|
if (css_param->update_flag.dp_config)
|
asd->params.config.dp_config = &css_param->dp_config;
|
|
if (css_param->update_flag.nr_config)
|
asd->params.config.nr_config = &css_param->nr_config;
|
|
if (css_param->update_flag.ee_config)
|
asd->params.config.ee_config = &css_param->ee_config;
|
|
if (css_param->update_flag.tnr_config)
|
asd->params.config.tnr_config = &css_param->tnr_config;
|
|
if (css_param->update_flag.a3a_config)
|
asd->params.config.s3a_config = &css_param->s3a_config;
|
|
if (css_param->update_flag.ctc_config)
|
asd->params.config.ctc_config = &css_param->ctc_config;
|
|
if (css_param->update_flag.cnr_config)
|
asd->params.config.cnr_config = &css_param->cnr_config;
|
|
if (css_param->update_flag.ecd_config)
|
asd->params.config.ecd_config = &css_param->ecd_config;
|
|
if (css_param->update_flag.ynr_config)
|
asd->params.config.ynr_config = &css_param->ynr_config;
|
|
if (css_param->update_flag.fc_config)
|
asd->params.config.fc_config = &css_param->fc_config;
|
|
if (css_param->update_flag.macc_config)
|
asd->params.config.macc_config = &css_param->macc_config;
|
|
if (css_param->update_flag.aa_config)
|
asd->params.config.aa_config = &css_param->aa_config;
|
|
if (css_param->update_flag.anr_config)
|
asd->params.config.anr_config = &css_param->anr_config;
|
|
if (css_param->update_flag.xnr_config)
|
asd->params.config.xnr_config = &css_param->xnr_config;
|
|
if (css_param->update_flag.yuv2rgb_cc_config)
|
asd->params.config.yuv2rgb_cc_config = &css_param->yuv2rgb_cc_config;
|
|
if (css_param->update_flag.rgb2yuv_cc_config)
|
asd->params.config.rgb2yuv_cc_config = &css_param->rgb2yuv_cc_config;
|
|
if (css_param->update_flag.macc_table)
|
asd->params.config.macc_table = &css_param->macc_table;
|
|
if (css_param->update_flag.xnr_table)
|
asd->params.config.xnr_table = &css_param->xnr_table;
|
|
if (css_param->update_flag.r_gamma_table)
|
asd->params.config.r_gamma_table = &css_param->r_gamma_table;
|
|
if (css_param->update_flag.g_gamma_table)
|
asd->params.config.g_gamma_table = &css_param->g_gamma_table;
|
|
if (css_param->update_flag.b_gamma_table)
|
asd->params.config.b_gamma_table = &css_param->b_gamma_table;
|
|
if (css_param->update_flag.anr_thres)
|
atomisp_css_set_anr_thres(asd, &css_param->anr_thres);
|
|
if (css_param->update_flag.shading_table)
|
asd->params.config.shading_table = css_param->shading_table;
|
|
if (css_param->update_flag.morph_table && asd->params.gdc_cac_en)
|
asd->params.config.morph_table = css_param->morph_table;
|
|
if (css_param->update_flag.dvs2_coefs) {
|
struct ia_css_dvs_grid_info *dvs_grid_info =
|
atomisp_css_get_dvs_grid_info(
|
&asd->params.curr_grid_info);
|
|
if (dvs_grid_info && dvs_grid_info->enable)
|
atomisp_css_set_dvs2_coefs(asd, css_param->dvs2_coeff);
|
}
|
|
if (css_param->update_flag.dvs_6axis_config)
|
atomisp_css_set_dvs_6axis(asd, css_param->dvs_6axis);
|
|
atomisp_css_set_isp_config_id(asd, css_param->isp_config_id);
|
/*
|
* These configurations are on used by ISP1.x, not for ISP2.x,
|
* so do not handle them. see comments of ia_css_isp_config.
|
* 1 cc_config
|
* 2 ce_config
|
* 3 de_config
|
* 4 gc_config
|
* 5 gamma_table
|
* 6 ctc_table
|
* 7 dvs_coefs
|
*/
|
}
|
|
static unsigned int long copy_from_compatible(void *to, const void *from,
|
unsigned long n, bool from_user)
|
{
|
if (from_user)
|
return copy_from_user(to, (void __user *)from, n);
|
else
|
memcpy(to, from, n);
|
return 0;
|
}
|
|
int atomisp_cp_general_isp_parameters(struct atomisp_sub_device *asd,
|
struct atomisp_parameters *arg,
|
struct atomisp_css_params *css_param,
|
bool from_user)
|
{
|
struct atomisp_parameters *cur_config = &css_param->update_flag;
|
|
if (!arg || !asd || !css_param)
|
return -EINVAL;
|
|
if (arg->wb_config && (from_user || !cur_config->wb_config)) {
|
if (copy_from_compatible(&css_param->wb_config, arg->wb_config,
|
sizeof(struct ia_css_wb_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.wb_config =
|
(struct atomisp_wb_config *)&css_param->wb_config;
|
}
|
|
if (arg->ob_config && (from_user || !cur_config->ob_config)) {
|
if (copy_from_compatible(&css_param->ob_config, arg->ob_config,
|
sizeof(struct ia_css_ob_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.ob_config =
|
(struct atomisp_ob_config *)&css_param->ob_config;
|
}
|
|
if (arg->dp_config && (from_user || !cur_config->dp_config)) {
|
if (copy_from_compatible(&css_param->dp_config, arg->dp_config,
|
sizeof(struct ia_css_dp_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.dp_config =
|
(struct atomisp_dp_config *)&css_param->dp_config;
|
}
|
|
if (asd->run_mode->val != ATOMISP_RUN_MODE_VIDEO) {
|
if (arg->dz_config && (from_user || !cur_config->dz_config)) {
|
if (copy_from_compatible(&css_param->dz_config,
|
arg->dz_config,
|
sizeof(struct ia_css_dz_config),
|
from_user))
|
return -EFAULT;
|
if (!atomisp_check_zoom_region(asd,
|
&css_param->dz_config)) {
|
dev_err(asd->isp->dev, "crop region error!");
|
return -EINVAL;
|
}
|
css_param->update_flag.dz_config =
|
(struct atomisp_dz_config *)
|
&css_param->dz_config;
|
}
|
}
|
|
if (arg->nr_config && (from_user || !cur_config->nr_config)) {
|
if (copy_from_compatible(&css_param->nr_config, arg->nr_config,
|
sizeof(struct ia_css_nr_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.nr_config =
|
(struct atomisp_nr_config *)&css_param->nr_config;
|
}
|
|
if (arg->ee_config && (from_user || !cur_config->ee_config)) {
|
if (copy_from_compatible(&css_param->ee_config, arg->ee_config,
|
sizeof(struct ia_css_ee_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.ee_config =
|
(struct atomisp_ee_config *)&css_param->ee_config;
|
}
|
|
if (arg->tnr_config && (from_user || !cur_config->tnr_config)) {
|
if (copy_from_compatible(&css_param->tnr_config,
|
arg->tnr_config,
|
sizeof(struct ia_css_tnr_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.tnr_config =
|
(struct atomisp_tnr_config *)
|
&css_param->tnr_config;
|
}
|
|
if (arg->a3a_config && (from_user || !cur_config->a3a_config)) {
|
if (copy_from_compatible(&css_param->s3a_config,
|
arg->a3a_config,
|
sizeof(struct ia_css_3a_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.a3a_config =
|
(struct atomisp_3a_config *)&css_param->s3a_config;
|
}
|
|
if (arg->ctc_config && (from_user || !cur_config->ctc_config)) {
|
if (copy_from_compatible(&css_param->ctc_config,
|
arg->ctc_config,
|
sizeof(struct ia_css_ctc_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.ctc_config =
|
(struct atomisp_ctc_config *)
|
&css_param->ctc_config;
|
}
|
|
if (arg->cnr_config && (from_user || !cur_config->cnr_config)) {
|
if (copy_from_compatible(&css_param->cnr_config,
|
arg->cnr_config,
|
sizeof(struct ia_css_cnr_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.cnr_config =
|
(struct atomisp_cnr_config *)
|
&css_param->cnr_config;
|
}
|
|
if (arg->ecd_config && (from_user || !cur_config->ecd_config)) {
|
if (copy_from_compatible(&css_param->ecd_config,
|
arg->ecd_config,
|
sizeof(struct ia_css_ecd_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.ecd_config =
|
(struct atomisp_ecd_config *)
|
&css_param->ecd_config;
|
}
|
|
if (arg->ynr_config && (from_user || !cur_config->ynr_config)) {
|
if (copy_from_compatible(&css_param->ynr_config,
|
arg->ynr_config,
|
sizeof(struct ia_css_ynr_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.ynr_config =
|
(struct atomisp_ynr_config *)
|
&css_param->ynr_config;
|
}
|
|
if (arg->fc_config && (from_user || !cur_config->fc_config)) {
|
if (copy_from_compatible(&css_param->fc_config,
|
arg->fc_config,
|
sizeof(struct ia_css_fc_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.fc_config =
|
(struct atomisp_fc_config *)&css_param->fc_config;
|
}
|
|
if (arg->macc_config && (from_user || !cur_config->macc_config)) {
|
if (copy_from_compatible(&css_param->macc_config,
|
arg->macc_config,
|
sizeof(struct ia_css_macc_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.macc_config =
|
(struct atomisp_macc_config *)
|
&css_param->macc_config;
|
}
|
|
if (arg->aa_config && (from_user || !cur_config->aa_config)) {
|
if (copy_from_compatible(&css_param->aa_config, arg->aa_config,
|
sizeof(struct ia_css_aa_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.aa_config =
|
(struct atomisp_aa_config *)&css_param->aa_config;
|
}
|
|
if (arg->anr_config && (from_user || !cur_config->anr_config)) {
|
if (copy_from_compatible(&css_param->anr_config,
|
arg->anr_config,
|
sizeof(struct ia_css_anr_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.anr_config =
|
(struct atomisp_anr_config *)
|
&css_param->anr_config;
|
}
|
|
if (arg->xnr_config && (from_user || !cur_config->xnr_config)) {
|
if (copy_from_compatible(&css_param->xnr_config,
|
arg->xnr_config,
|
sizeof(struct ia_css_xnr_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.xnr_config =
|
(struct atomisp_xnr_config *)
|
&css_param->xnr_config;
|
}
|
|
if (arg->yuv2rgb_cc_config &&
|
(from_user || !cur_config->yuv2rgb_cc_config)) {
|
if (copy_from_compatible(&css_param->yuv2rgb_cc_config,
|
arg->yuv2rgb_cc_config,
|
sizeof(struct ia_css_cc_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.yuv2rgb_cc_config =
|
(struct atomisp_cc_config *)
|
&css_param->yuv2rgb_cc_config;
|
}
|
|
if (arg->rgb2yuv_cc_config &&
|
(from_user || !cur_config->rgb2yuv_cc_config)) {
|
if (copy_from_compatible(&css_param->rgb2yuv_cc_config,
|
arg->rgb2yuv_cc_config,
|
sizeof(struct ia_css_cc_config),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.rgb2yuv_cc_config =
|
(struct atomisp_cc_config *)
|
&css_param->rgb2yuv_cc_config;
|
}
|
|
if (arg->macc_table && (from_user || !cur_config->macc_table)) {
|
if (copy_from_compatible(&css_param->macc_table,
|
arg->macc_table,
|
sizeof(struct ia_css_macc_table),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.macc_table =
|
(struct atomisp_macc_table *)
|
&css_param->macc_table;
|
}
|
|
if (arg->xnr_table && (from_user || !cur_config->xnr_table)) {
|
if (copy_from_compatible(&css_param->xnr_table,
|
arg->xnr_table,
|
sizeof(struct ia_css_xnr_table),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.xnr_table =
|
(struct atomisp_xnr_table *)&css_param->xnr_table;
|
}
|
|
if (arg->r_gamma_table && (from_user || !cur_config->r_gamma_table)) {
|
if (copy_from_compatible(&css_param->r_gamma_table,
|
arg->r_gamma_table,
|
sizeof(struct ia_css_rgb_gamma_table),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.r_gamma_table =
|
(struct atomisp_rgb_gamma_table *)
|
&css_param->r_gamma_table;
|
}
|
|
if (arg->g_gamma_table && (from_user || !cur_config->g_gamma_table)) {
|
if (copy_from_compatible(&css_param->g_gamma_table,
|
arg->g_gamma_table,
|
sizeof(struct ia_css_rgb_gamma_table),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.g_gamma_table =
|
(struct atomisp_rgb_gamma_table *)
|
&css_param->g_gamma_table;
|
}
|
|
if (arg->b_gamma_table && (from_user || !cur_config->b_gamma_table)) {
|
if (copy_from_compatible(&css_param->b_gamma_table,
|
arg->b_gamma_table,
|
sizeof(struct ia_css_rgb_gamma_table),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.b_gamma_table =
|
(struct atomisp_rgb_gamma_table *)
|
&css_param->b_gamma_table;
|
}
|
|
if (arg->anr_thres && (from_user || !cur_config->anr_thres)) {
|
if (copy_from_compatible(&css_param->anr_thres, arg->anr_thres,
|
sizeof(struct ia_css_anr_thres),
|
from_user))
|
return -EFAULT;
|
css_param->update_flag.anr_thres =
|
(struct atomisp_anr_thres *)&css_param->anr_thres;
|
}
|
|
if (from_user)
|
css_param->isp_config_id = arg->isp_config_id;
|
/*
|
* These configurations are on used by ISP1.x, not for ISP2.x,
|
* so do not handle them. see comments of ia_css_isp_config.
|
* 1 cc_config
|
* 2 ce_config
|
* 3 de_config
|
* 4 gc_config
|
* 5 gamma_table
|
* 6 ctc_table
|
* 7 dvs_coefs
|
*/
|
return 0;
|
}
|
|
int atomisp_cp_lsc_table(struct atomisp_sub_device *asd,
|
struct atomisp_shading_table *source_st,
|
struct atomisp_css_params *css_param,
|
bool from_user)
|
{
|
unsigned int i;
|
unsigned int len_table;
|
struct ia_css_shading_table *shading_table;
|
struct ia_css_shading_table *old_table;
|
struct atomisp_shading_table *st, dest_st;
|
|
if (!source_st)
|
return 0;
|
|
if (!css_param)
|
return -EINVAL;
|
|
if (!from_user && css_param->update_flag.shading_table)
|
return 0;
|
|
if (IS_ISP2401) {
|
if (copy_from_compatible(&dest_st, source_st,
|
sizeof(struct atomisp_shading_table),
|
from_user)) {
|
dev_err(asd->isp->dev, "copy shading table failed!");
|
return -EFAULT;
|
}
|
st = &dest_st;
|
} else {
|
st = source_st;
|
}
|
|
old_table = css_param->shading_table;
|
|
/* user config is to disable the shading table. */
|
if (!st->enable) {
|
/* Generate a minimum table with enable = 0. */
|
shading_table = atomisp_css_shading_table_alloc(1, 1);
|
if (!shading_table)
|
return -ENOMEM;
|
shading_table->enable = 0;
|
goto set_lsc;
|
}
|
|
/* Setting a new table. Validate first - all tables must be set */
|
for (i = 0; i < ATOMISP_NUM_SC_COLORS; i++) {
|
if (!st->data[i]) {
|
dev_err(asd->isp->dev, "shading table validate failed");
|
return -EINVAL;
|
}
|
}
|
|
/* Shading table size per color */
|
if (!IS_ISP2401) {
|
if (st->width > ISP2400_SH_CSS_MAX_SCTBL_WIDTH_PER_COLOR ||
|
st->height > ISP2400_SH_CSS_MAX_SCTBL_HEIGHT_PER_COLOR) {
|
dev_err(asd->isp->dev, "shading table w/h validate failed!");
|
return -EINVAL;
|
}
|
} else {
|
if (st->width > ISP2401_SH_CSS_MAX_SCTBL_WIDTH_PER_COLOR ||
|
st->height > ISP2401_SH_CSS_MAX_SCTBL_HEIGHT_PER_COLOR) {
|
dev_err(asd->isp->dev, "shading table w/h validate failed!");
|
return -EINVAL;
|
}
|
}
|
|
shading_table = atomisp_css_shading_table_alloc(st->width, st->height);
|
if (!shading_table)
|
return -ENOMEM;
|
|
len_table = st->width * st->height * ATOMISP_SC_TYPE_SIZE;
|
for (i = 0; i < ATOMISP_NUM_SC_COLORS; i++) {
|
if (copy_from_compatible(shading_table->data[i],
|
st->data[i], len_table, from_user)) {
|
atomisp_css_shading_table_free(shading_table);
|
return -EFAULT;
|
}
|
}
|
shading_table->sensor_width = st->sensor_width;
|
shading_table->sensor_height = st->sensor_height;
|
shading_table->fraction_bits = st->fraction_bits;
|
shading_table->enable = st->enable;
|
|
/* No need to update shading table if it is the same */
|
if (old_table &&
|
old_table->sensor_width == shading_table->sensor_width &&
|
old_table->sensor_height == shading_table->sensor_height &&
|
old_table->width == shading_table->width &&
|
old_table->height == shading_table->height &&
|
old_table->fraction_bits == shading_table->fraction_bits &&
|
old_table->enable == shading_table->enable) {
|
bool data_is_same = true;
|
|
for (i = 0; i < ATOMISP_NUM_SC_COLORS; i++) {
|
if (memcmp(shading_table->data[i], old_table->data[i],
|
len_table) != 0) {
|
data_is_same = false;
|
break;
|
}
|
}
|
|
if (data_is_same) {
|
atomisp_css_shading_table_free(shading_table);
|
return 0;
|
}
|
}
|
|
set_lsc:
|
/* set LSC to CSS */
|
css_param->shading_table = shading_table;
|
css_param->update_flag.shading_table = (struct atomisp_shading_table *)shading_table;
|
asd->params.sc_en = shading_table;
|
|
if (old_table)
|
atomisp_css_shading_table_free(old_table);
|
|
return 0;
|
}
|
|
int atomisp_css_cp_dvs2_coefs(struct atomisp_sub_device *asd,
|
struct ia_css_dvs2_coefficients *coefs,
|
struct atomisp_css_params *css_param,
|
bool from_user)
|
{
|
struct ia_css_dvs_grid_info *cur =
|
atomisp_css_get_dvs_grid_info(&asd->params.curr_grid_info);
|
int dvs_hor_coef_bytes, dvs_ver_coef_bytes;
|
struct ia_css_dvs2_coefficients dvs2_coefs;
|
|
if (!coefs || !cur)
|
return 0;
|
|
if (!from_user && css_param->update_flag.dvs2_coefs)
|
return 0;
|
|
if (!IS_ISP2401) {
|
if (sizeof(*cur) != sizeof(coefs->grid) ||
|
memcmp(&coefs->grid, cur, sizeof(coefs->grid))) {
|
dev_err(asd->isp->dev, "dvs grid mis-match!\n");
|
/* If the grid info in the argument differs from the current
|
grid info, we tell the caller to reset the grid size and
|
try again. */
|
return -EAGAIN;
|
}
|
|
if (!coefs->hor_coefs.odd_real ||
|
!coefs->hor_coefs.odd_imag ||
|
!coefs->hor_coefs.even_real ||
|
!coefs->hor_coefs.even_imag ||
|
!coefs->ver_coefs.odd_real ||
|
!coefs->ver_coefs.odd_imag ||
|
!coefs->ver_coefs.even_real ||
|
!coefs->ver_coefs.even_imag)
|
return -EINVAL;
|
|
if (!css_param->dvs2_coeff) {
|
/* DIS coefficients. */
|
css_param->dvs2_coeff = ia_css_dvs2_coefficients_allocate(cur);
|
if (!css_param->dvs2_coeff)
|
return -ENOMEM;
|
}
|
|
dvs_hor_coef_bytes = asd->params.dvs_hor_coef_bytes;
|
dvs_ver_coef_bytes = asd->params.dvs_ver_coef_bytes;
|
if (copy_from_compatible(css_param->dvs2_coeff->hor_coefs.odd_real,
|
coefs->hor_coefs.odd_real, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->hor_coefs.odd_imag,
|
coefs->hor_coefs.odd_imag, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->hor_coefs.even_real,
|
coefs->hor_coefs.even_real, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->hor_coefs.even_imag,
|
coefs->hor_coefs.even_imag, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.odd_real,
|
coefs->ver_coefs.odd_real, dvs_ver_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.odd_imag,
|
coefs->ver_coefs.odd_imag, dvs_ver_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.even_real,
|
coefs->ver_coefs.even_real, dvs_ver_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.even_imag,
|
coefs->ver_coefs.even_imag, dvs_ver_coef_bytes, from_user)) {
|
ia_css_dvs2_coefficients_free(css_param->dvs2_coeff);
|
css_param->dvs2_coeff = NULL;
|
return -EFAULT;
|
}
|
} else {
|
if (copy_from_compatible(&dvs2_coefs, coefs,
|
sizeof(struct ia_css_dvs2_coefficients),
|
from_user)) {
|
dev_err(asd->isp->dev, "copy dvs2 coef failed");
|
return -EFAULT;
|
}
|
|
if (sizeof(*cur) != sizeof(dvs2_coefs.grid) ||
|
memcmp(&dvs2_coefs.grid, cur, sizeof(dvs2_coefs.grid))) {
|
dev_err(asd->isp->dev, "dvs grid mis-match!\n");
|
/* If the grid info in the argument differs from the current
|
grid info, we tell the caller to reset the grid size and
|
try again. */
|
return -EAGAIN;
|
}
|
|
if (!dvs2_coefs.hor_coefs.odd_real ||
|
!dvs2_coefs.hor_coefs.odd_imag ||
|
!dvs2_coefs.hor_coefs.even_real ||
|
!dvs2_coefs.hor_coefs.even_imag ||
|
!dvs2_coefs.ver_coefs.odd_real ||
|
!dvs2_coefs.ver_coefs.odd_imag ||
|
!dvs2_coefs.ver_coefs.even_real ||
|
!dvs2_coefs.ver_coefs.even_imag)
|
return -EINVAL;
|
|
if (!css_param->dvs2_coeff) {
|
/* DIS coefficients. */
|
css_param->dvs2_coeff = ia_css_dvs2_coefficients_allocate(cur);
|
if (!css_param->dvs2_coeff)
|
return -ENOMEM;
|
}
|
|
dvs_hor_coef_bytes = asd->params.dvs_hor_coef_bytes;
|
dvs_ver_coef_bytes = asd->params.dvs_ver_coef_bytes;
|
if (copy_from_compatible(css_param->dvs2_coeff->hor_coefs.odd_real,
|
dvs2_coefs.hor_coefs.odd_real, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->hor_coefs.odd_imag,
|
dvs2_coefs.hor_coefs.odd_imag, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->hor_coefs.even_real,
|
dvs2_coefs.hor_coefs.even_real, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->hor_coefs.even_imag,
|
dvs2_coefs.hor_coefs.even_imag, dvs_hor_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.odd_real,
|
dvs2_coefs.ver_coefs.odd_real, dvs_ver_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.odd_imag,
|
dvs2_coefs.ver_coefs.odd_imag, dvs_ver_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.even_real,
|
dvs2_coefs.ver_coefs.even_real, dvs_ver_coef_bytes, from_user) ||
|
copy_from_compatible(css_param->dvs2_coeff->ver_coefs.even_imag,
|
dvs2_coefs.ver_coefs.even_imag, dvs_ver_coef_bytes, from_user)) {
|
ia_css_dvs2_coefficients_free(css_param->dvs2_coeff);
|
css_param->dvs2_coeff = NULL;
|
return -EFAULT;
|
}
|
}
|
|
css_param->update_flag.dvs2_coefs =
|
(struct atomisp_dis_coefficients *)css_param->dvs2_coeff;
|
return 0;
|
}
|
|
int atomisp_cp_dvs_6axis_config(struct atomisp_sub_device *asd,
|
struct atomisp_dvs_6axis_config *source_6axis_config,
|
struct atomisp_css_params *css_param,
|
bool from_user)
|
{
|
struct ia_css_dvs_6axis_config *dvs_6axis_config;
|
struct ia_css_dvs_6axis_config *old_6axis_config;
|
struct ia_css_stream *stream =
|
asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream;
|
struct ia_css_dvs_grid_info *dvs_grid_info =
|
atomisp_css_get_dvs_grid_info(&asd->params.curr_grid_info);
|
int ret = -EFAULT;
|
|
if (!stream) {
|
dev_err(asd->isp->dev, "%s: internal error!", __func__);
|
return -EINVAL;
|
}
|
|
if (!source_6axis_config || !dvs_grid_info)
|
return 0;
|
|
if (!dvs_grid_info->enable)
|
return 0;
|
|
if (!from_user && css_param->update_flag.dvs_6axis_config)
|
return 0;
|
|
/* check whether need to reallocate for 6 axis config */
|
old_6axis_config = css_param->dvs_6axis;
|
dvs_6axis_config = old_6axis_config;
|
|
if (IS_ISP2401) {
|
struct ia_css_dvs_6axis_config t_6axis_config;
|
|
if (copy_from_compatible(&t_6axis_config, source_6axis_config,
|
sizeof(struct atomisp_dvs_6axis_config),
|
from_user)) {
|
dev_err(asd->isp->dev, "copy morph table failed!");
|
return -EFAULT;
|
}
|
|
if (old_6axis_config &&
|
(old_6axis_config->width_y != t_6axis_config.width_y ||
|
old_6axis_config->height_y != t_6axis_config.height_y ||
|
old_6axis_config->width_uv != t_6axis_config.width_uv ||
|
old_6axis_config->height_uv != t_6axis_config.height_uv)) {
|
ia_css_dvs2_6axis_config_free(css_param->dvs_6axis);
|
css_param->dvs_6axis = NULL;
|
|
dvs_6axis_config = ia_css_dvs2_6axis_config_allocate(stream);
|
if (!dvs_6axis_config)
|
return -ENOMEM;
|
} else if (!dvs_6axis_config) {
|
dvs_6axis_config = ia_css_dvs2_6axis_config_allocate(stream);
|
if (!dvs_6axis_config)
|
return -ENOMEM;
|
}
|
|
dvs_6axis_config->exp_id = t_6axis_config.exp_id;
|
|
if (copy_from_compatible(dvs_6axis_config->xcoords_y,
|
t_6axis_config.xcoords_y,
|
t_6axis_config.width_y *
|
t_6axis_config.height_y *
|
sizeof(*dvs_6axis_config->xcoords_y),
|
from_user))
|
goto error;
|
if (copy_from_compatible(dvs_6axis_config->ycoords_y,
|
t_6axis_config.ycoords_y,
|
t_6axis_config.width_y *
|
t_6axis_config.height_y *
|
sizeof(*dvs_6axis_config->ycoords_y),
|
from_user))
|
goto error;
|
if (copy_from_compatible(dvs_6axis_config->xcoords_uv,
|
t_6axis_config.xcoords_uv,
|
t_6axis_config.width_uv *
|
t_6axis_config.height_uv *
|
sizeof(*dvs_6axis_config->xcoords_uv),
|
from_user))
|
goto error;
|
if (copy_from_compatible(dvs_6axis_config->ycoords_uv,
|
t_6axis_config.ycoords_uv,
|
t_6axis_config.width_uv *
|
t_6axis_config.height_uv *
|
sizeof(*dvs_6axis_config->ycoords_uv),
|
from_user))
|
goto error;
|
} else {
|
if (old_6axis_config &&
|
(old_6axis_config->width_y != source_6axis_config->width_y ||
|
old_6axis_config->height_y != source_6axis_config->height_y ||
|
old_6axis_config->width_uv != source_6axis_config->width_uv ||
|
old_6axis_config->height_uv != source_6axis_config->height_uv)) {
|
ia_css_dvs2_6axis_config_free(css_param->dvs_6axis);
|
css_param->dvs_6axis = NULL;
|
|
dvs_6axis_config = ia_css_dvs2_6axis_config_allocate(stream);
|
if (!dvs_6axis_config)
|
return -ENOMEM;
|
} else if (!dvs_6axis_config) {
|
dvs_6axis_config = ia_css_dvs2_6axis_config_allocate(stream);
|
if (!dvs_6axis_config)
|
return -ENOMEM;
|
}
|
|
dvs_6axis_config->exp_id = source_6axis_config->exp_id;
|
|
if (copy_from_compatible(dvs_6axis_config->xcoords_y,
|
source_6axis_config->xcoords_y,
|
source_6axis_config->width_y *
|
source_6axis_config->height_y *
|
sizeof(*source_6axis_config->xcoords_y),
|
from_user))
|
goto error;
|
if (copy_from_compatible(dvs_6axis_config->ycoords_y,
|
source_6axis_config->ycoords_y,
|
source_6axis_config->width_y *
|
source_6axis_config->height_y *
|
sizeof(*source_6axis_config->ycoords_y),
|
from_user))
|
goto error;
|
if (copy_from_compatible(dvs_6axis_config->xcoords_uv,
|
source_6axis_config->xcoords_uv,
|
source_6axis_config->width_uv *
|
source_6axis_config->height_uv *
|
sizeof(*source_6axis_config->xcoords_uv),
|
from_user))
|
goto error;
|
if (copy_from_compatible(dvs_6axis_config->ycoords_uv,
|
source_6axis_config->ycoords_uv,
|
source_6axis_config->width_uv *
|
source_6axis_config->height_uv *
|
sizeof(*source_6axis_config->ycoords_uv),
|
from_user))
|
goto error;
|
}
|
css_param->dvs_6axis = dvs_6axis_config;
|
css_param->update_flag.dvs_6axis_config =
|
(struct atomisp_dvs_6axis_config *)dvs_6axis_config;
|
return 0;
|
|
error:
|
if (dvs_6axis_config)
|
ia_css_dvs2_6axis_config_free(dvs_6axis_config);
|
return ret;
|
}
|
|
int atomisp_cp_morph_table(struct atomisp_sub_device *asd,
|
struct atomisp_morph_table *source_morph_table,
|
struct atomisp_css_params *css_param,
|
bool from_user)
|
{
|
int ret = -EFAULT;
|
unsigned int i;
|
struct ia_css_morph_table *morph_table;
|
struct ia_css_morph_table *old_morph_table;
|
|
if (!source_morph_table)
|
return 0;
|
|
if (!from_user && css_param->update_flag.morph_table)
|
return 0;
|
|
old_morph_table = css_param->morph_table;
|
|
if (IS_ISP2401) {
|
struct ia_css_morph_table mtbl;
|
|
if (copy_from_compatible(&mtbl, source_morph_table,
|
sizeof(struct atomisp_morph_table),
|
from_user)) {
|
dev_err(asd->isp->dev, "copy morph table failed!");
|
return -EFAULT;
|
}
|
|
morph_table = atomisp_css_morph_table_allocate(
|
mtbl.width,
|
mtbl.height);
|
if (!morph_table)
|
return -ENOMEM;
|
|
for (i = 0; i < IA_CSS_MORPH_TABLE_NUM_PLANES; i++) {
|
if (copy_from_compatible(morph_table->coordinates_x[i],
|
(__force void *)source_morph_table->coordinates_x[i],
|
mtbl.height * mtbl.width *
|
sizeof(*morph_table->coordinates_x[i]),
|
from_user))
|
goto error;
|
|
if (copy_from_compatible(morph_table->coordinates_y[i],
|
(__force void *)source_morph_table->coordinates_y[i],
|
mtbl.height * mtbl.width *
|
sizeof(*morph_table->coordinates_y[i]),
|
from_user))
|
goto error;
|
}
|
} else {
|
morph_table = atomisp_css_morph_table_allocate(
|
source_morph_table->width,
|
source_morph_table->height);
|
if (!morph_table)
|
return -ENOMEM;
|
|
for (i = 0; i < IA_CSS_MORPH_TABLE_NUM_PLANES; i++) {
|
if (copy_from_compatible(morph_table->coordinates_x[i],
|
(__force void *)source_morph_table->coordinates_x[i],
|
source_morph_table->height * source_morph_table->width *
|
sizeof(*source_morph_table->coordinates_x[i]),
|
from_user))
|
goto error;
|
|
if (copy_from_compatible(morph_table->coordinates_y[i],
|
(__force void *)source_morph_table->coordinates_y[i],
|
source_morph_table->height * source_morph_table->width *
|
sizeof(*source_morph_table->coordinates_y[i]),
|
from_user))
|
goto error;
|
}
|
}
|
|
css_param->morph_table = morph_table;
|
if (old_morph_table)
|
atomisp_css_morph_table_free(old_morph_table);
|
css_param->update_flag.morph_table =
|
(struct atomisp_morph_table *)morph_table;
|
return 0;
|
|
error:
|
if (morph_table)
|
atomisp_css_morph_table_free(morph_table);
|
return ret;
|
}
|
|
int atomisp_makeup_css_parameters(struct atomisp_sub_device *asd,
|
struct atomisp_parameters *arg,
|
struct atomisp_css_params *css_param)
|
{
|
int ret;
|
|
ret = atomisp_cp_general_isp_parameters(asd, arg, css_param, false);
|
if (ret)
|
return ret;
|
ret = atomisp_cp_lsc_table(asd, arg->shading_table, css_param, false);
|
if (ret)
|
return ret;
|
ret = atomisp_cp_morph_table(asd, arg->morph_table, css_param, false);
|
if (ret)
|
return ret;
|
ret = atomisp_css_cp_dvs2_coefs(asd,
|
(struct ia_css_dvs2_coefficients *)arg->dvs2_coefs,
|
css_param, false);
|
if (ret)
|
return ret;
|
ret = atomisp_cp_dvs_6axis_config(asd, arg->dvs_6axis_config,
|
css_param, false);
|
return ret;
|
}
|
|
void atomisp_free_css_parameters(struct atomisp_css_params *css_param)
|
{
|
if (css_param->dvs_6axis) {
|
ia_css_dvs2_6axis_config_free(css_param->dvs_6axis);
|
css_param->dvs_6axis = NULL;
|
}
|
if (css_param->dvs2_coeff) {
|
ia_css_dvs2_coefficients_free(css_param->dvs2_coeff);
|
css_param->dvs2_coeff = NULL;
|
}
|
if (css_param->shading_table) {
|
ia_css_shading_table_free(css_param->shading_table);
|
css_param->shading_table = NULL;
|
}
|
if (css_param->morph_table) {
|
ia_css_morph_table_free(css_param->morph_table);
|
css_param->morph_table = NULL;
|
}
|
}
|
|
/*
|
* Check parameter queue list and buffer queue list to find out if matched items
|
* and then set parameter to CSS and enqueue buffer to CSS.
|
* Of course, if the buffer in buffer waiting list is not bound to a per-frame
|
* parameter, it will be enqueued into CSS as long as the per-frame setting
|
* buffers before it get enqueued.
|
*/
|
void atomisp_handle_parameter_and_buffer(struct atomisp_video_pipe *pipe)
|
{
|
struct atomisp_sub_device *asd = pipe->asd;
|
struct videobuf_buffer *vb = NULL, *vb_tmp;
|
struct atomisp_css_params_with_list *param = NULL, *param_tmp;
|
struct videobuf_vmalloc_memory *vm_mem = NULL;
|
unsigned long irqflags;
|
bool need_to_enqueue_buffer = false;
|
|
if (!asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, pipe->vdev.name);
|
return;
|
}
|
|
if (atomisp_is_vf_pipe(pipe))
|
return;
|
|
/*
|
* CSS/FW requires set parameter and enqueue buffer happen after ISP
|
* is streamon.
|
*/
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED)
|
return;
|
|
if (list_empty(&pipe->per_frame_params) ||
|
list_empty(&pipe->buffers_waiting_for_param))
|
return;
|
|
list_for_each_entry_safe(vb, vb_tmp,
|
&pipe->buffers_waiting_for_param, queue) {
|
if (pipe->frame_request_config_id[vb->i]) {
|
list_for_each_entry_safe(param, param_tmp,
|
&pipe->per_frame_params, list) {
|
if (pipe->frame_request_config_id[vb->i] !=
|
param->params.isp_config_id)
|
continue;
|
|
list_del(¶m->list);
|
list_del(&vb->queue);
|
/*
|
* clear the request config id as the buffer
|
* will be handled and enqueued into CSS soon
|
*/
|
pipe->frame_request_config_id[vb->i] = 0;
|
pipe->frame_params[vb->i] = param;
|
vm_mem = vb->priv;
|
BUG_ON(!vm_mem);
|
break;
|
}
|
|
if (vm_mem) {
|
spin_lock_irqsave(&pipe->irq_lock, irqflags);
|
list_add_tail(&vb->queue, &pipe->activeq);
|
spin_unlock_irqrestore(&pipe->irq_lock, irqflags);
|
vm_mem = NULL;
|
need_to_enqueue_buffer = true;
|
} else {
|
/* The is the end, stop further loop */
|
break;
|
}
|
} else {
|
list_del(&vb->queue);
|
pipe->frame_params[vb->i] = NULL;
|
spin_lock_irqsave(&pipe->irq_lock, irqflags);
|
list_add_tail(&vb->queue, &pipe->activeq);
|
spin_unlock_irqrestore(&pipe->irq_lock, irqflags);
|
need_to_enqueue_buffer = true;
|
}
|
}
|
|
if (!need_to_enqueue_buffer)
|
return;
|
|
atomisp_qbuffers_to_css(asd);
|
|
if (!IS_ISP2401) {
|
if (!atomisp_is_wdt_running(asd) && atomisp_buffers_queued(asd))
|
atomisp_wdt_start(asd);
|
} else {
|
if (atomisp_buffers_queued_pipe(pipe)) {
|
if (!atomisp_is_wdt_running(pipe))
|
atomisp_wdt_start_pipe(pipe);
|
else
|
atomisp_wdt_refresh_pipe(pipe,
|
ATOMISP_WDT_KEEP_CURRENT_DELAY);
|
}
|
}
|
}
|
|
/*
|
* Function to configure ISP parameters
|
*/
|
int atomisp_set_parameters(struct video_device *vdev,
|
struct atomisp_parameters *arg)
|
{
|
struct atomisp_video_pipe *pipe = atomisp_to_video_pipe(vdev);
|
struct atomisp_sub_device *asd = pipe->asd;
|
struct atomisp_css_params_with_list *param = NULL;
|
struct atomisp_css_params *css_param = &asd->params.css_param;
|
int ret;
|
|
if (!asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, vdev->name);
|
return -EINVAL;
|
}
|
|
if (!asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream) {
|
dev_err(asd->isp->dev, "%s: internal error!\n", __func__);
|
return -EINVAL;
|
}
|
|
dev_dbg(asd->isp->dev,
|
"%s: set parameter(per_frame_setting %d) for asd%d with isp_config_id %d of %s\n",
|
__func__, arg->per_frame_setting, asd->index,
|
arg->isp_config_id, vdev->name);
|
|
if (IS_ISP2401) {
|
if (atomisp_is_vf_pipe(pipe) && arg->per_frame_setting) {
|
dev_err(asd->isp->dev, "%s: vf pipe not support per_frame_setting",
|
__func__);
|
return -EINVAL;
|
}
|
}
|
|
if (arg->per_frame_setting && !atomisp_is_vf_pipe(pipe)) {
|
/*
|
* Per-frame setting enabled, we allocate a new parameter
|
* buffer to cache the parameters and only when frame buffers
|
* are ready, the parameters will be set to CSS.
|
* per-frame setting only works for the main output frame.
|
*/
|
param = kvzalloc(sizeof(*param), GFP_KERNEL);
|
if (!param) {
|
dev_err(asd->isp->dev, "%s: failed to alloc params buffer\n",
|
__func__);
|
return -ENOMEM;
|
}
|
css_param = ¶m->params;
|
}
|
|
ret = atomisp_cp_general_isp_parameters(asd, arg, css_param, true);
|
if (ret)
|
goto apply_parameter_failed;
|
|
ret = atomisp_cp_lsc_table(asd, arg->shading_table, css_param, true);
|
if (ret)
|
goto apply_parameter_failed;
|
|
ret = atomisp_cp_morph_table(asd, arg->morph_table, css_param, true);
|
if (ret)
|
goto apply_parameter_failed;
|
|
ret = atomisp_css_cp_dvs2_coefs(asd,
|
(struct ia_css_dvs2_coefficients *)arg->dvs2_coefs,
|
css_param, true);
|
if (ret)
|
goto apply_parameter_failed;
|
|
ret = atomisp_cp_dvs_6axis_config(asd, arg->dvs_6axis_config,
|
css_param, true);
|
if (ret)
|
goto apply_parameter_failed;
|
|
if (!(arg->per_frame_setting && !atomisp_is_vf_pipe(pipe))) {
|
/* indicate to CSS that we have parameters to be updated */
|
asd->params.css_update_params_needed = true;
|
} else {
|
list_add_tail(¶m->list, &pipe->per_frame_params);
|
atomisp_handle_parameter_and_buffer(pipe);
|
}
|
|
return 0;
|
|
apply_parameter_failed:
|
if (css_param)
|
atomisp_free_css_parameters(css_param);
|
if (param)
|
kvfree(param);
|
|
return ret;
|
}
|
|
/*
|
* Function to set/get isp parameters to isp
|
*/
|
int atomisp_param(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_parm *config)
|
{
|
struct ia_css_pipe_config *vp_cfg =
|
&asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].
|
pipe_configs[IA_CSS_PIPE_ID_VIDEO];
|
|
/* Read parameter for 3A binary info */
|
if (flag == 0) {
|
struct ia_css_dvs_grid_info *dvs_grid_info =
|
atomisp_css_get_dvs_grid_info(
|
&asd->params.curr_grid_info);
|
|
atomisp_curr_user_grid_info(asd, &config->info);
|
|
/* We always return the resolution and stride even if there is
|
* no valid metadata. This allows the caller to get the
|
* information needed to allocate user-space buffers. */
|
config->metadata_config.metadata_height = asd->
|
stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream_info.
|
metadata_info.resolution.height;
|
config->metadata_config.metadata_stride = asd->
|
stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream_info.
|
metadata_info.stride;
|
|
/* update dvs grid info */
|
if (dvs_grid_info)
|
memcpy(&config->dvs_grid,
|
dvs_grid_info,
|
sizeof(struct ia_css_dvs_grid_info));
|
|
if (asd->run_mode->val != ATOMISP_RUN_MODE_VIDEO) {
|
config->dvs_envelop.width = 0;
|
config->dvs_envelop.height = 0;
|
return 0;
|
}
|
|
/* update dvs envelop info */
|
if (!asd->continuous_mode->val) {
|
config->dvs_envelop.width = vp_cfg->dvs_envelope.width;
|
config->dvs_envelop.height =
|
vp_cfg->dvs_envelope.height;
|
} else {
|
unsigned int dvs_w, dvs_h, dvs_w_max, dvs_h_max;
|
|
dvs_w = vp_cfg->bayer_ds_out_res.width -
|
vp_cfg->output_info[0].res.width;
|
dvs_h = vp_cfg->bayer_ds_out_res.height -
|
vp_cfg->output_info[0].res.height;
|
dvs_w_max = rounddown(
|
vp_cfg->output_info[0].res.width / 5,
|
ATOM_ISP_STEP_WIDTH);
|
dvs_h_max = rounddown(
|
vp_cfg->output_info[0].res.height / 5,
|
ATOM_ISP_STEP_HEIGHT);
|
|
config->dvs_envelop.width = min(dvs_w, dvs_w_max);
|
config->dvs_envelop.height = min(dvs_h, dvs_h_max);
|
}
|
|
return 0;
|
}
|
|
memcpy(&asd->params.css_param.wb_config, &config->wb_config,
|
sizeof(struct ia_css_wb_config));
|
memcpy(&asd->params.css_param.ob_config, &config->ob_config,
|
sizeof(struct ia_css_ob_config));
|
memcpy(&asd->params.css_param.dp_config, &config->dp_config,
|
sizeof(struct ia_css_dp_config));
|
memcpy(&asd->params.css_param.de_config, &config->de_config,
|
sizeof(struct ia_css_de_config));
|
memcpy(&asd->params.css_param.dz_config, &config->dz_config,
|
sizeof(struct ia_css_dz_config));
|
memcpy(&asd->params.css_param.ce_config, &config->ce_config,
|
sizeof(struct ia_css_ce_config));
|
memcpy(&asd->params.css_param.nr_config, &config->nr_config,
|
sizeof(struct ia_css_nr_config));
|
memcpy(&asd->params.css_param.ee_config, &config->ee_config,
|
sizeof(struct ia_css_ee_config));
|
memcpy(&asd->params.css_param.tnr_config, &config->tnr_config,
|
sizeof(struct ia_css_tnr_config));
|
|
if (asd->params.color_effect == V4L2_COLORFX_NEGATIVE) {
|
asd->params.css_param.cc_config.matrix[3] = -config->cc_config.matrix[3];
|
asd->params.css_param.cc_config.matrix[4] = -config->cc_config.matrix[4];
|
asd->params.css_param.cc_config.matrix[5] = -config->cc_config.matrix[5];
|
asd->params.css_param.cc_config.matrix[6] = -config->cc_config.matrix[6];
|
asd->params.css_param.cc_config.matrix[7] = -config->cc_config.matrix[7];
|
asd->params.css_param.cc_config.matrix[8] = -config->cc_config.matrix[8];
|
}
|
|
if (asd->params.color_effect != V4L2_COLORFX_SEPIA &&
|
asd->params.color_effect != V4L2_COLORFX_BW) {
|
memcpy(&asd->params.css_param.cc_config, &config->cc_config,
|
sizeof(struct ia_css_cc_config));
|
asd->params.config.cc_config = &asd->params.css_param.cc_config;
|
}
|
|
asd->params.config.wb_config = &asd->params.css_param.wb_config;
|
asd->params.config.ob_config = &asd->params.css_param.ob_config;
|
asd->params.config.de_config = &asd->params.css_param.de_config;
|
asd->params.config.dz_config = &asd->params.css_param.dz_config;
|
asd->params.config.ce_config = &asd->params.css_param.ce_config;
|
asd->params.config.dp_config = &asd->params.css_param.dp_config;
|
asd->params.config.nr_config = &asd->params.css_param.nr_config;
|
asd->params.config.ee_config = &asd->params.css_param.ee_config;
|
asd->params.config.tnr_config = &asd->params.css_param.tnr_config;
|
asd->params.css_update_params_needed = true;
|
|
return 0;
|
}
|
|
/*
|
* Function to configure color effect of the image
|
*/
|
int atomisp_color_effect(struct atomisp_sub_device *asd, int flag,
|
__s32 *effect)
|
{
|
struct ia_css_cc_config *cc_config = NULL;
|
struct ia_css_macc_table *macc_table = NULL;
|
struct ia_css_ctc_table *ctc_table = NULL;
|
int ret = 0;
|
struct v4l2_control control;
|
struct atomisp_device *isp = asd->isp;
|
|
if (flag == 0) {
|
*effect = asd->params.color_effect;
|
return 0;
|
}
|
|
control.id = V4L2_CID_COLORFX;
|
control.value = *effect;
|
ret =
|
v4l2_s_ctrl(NULL, isp->inputs[asd->input_curr].camera->ctrl_handler,
|
&control);
|
/*
|
* if set color effect to sensor successfully, return
|
* 0 directly.
|
*/
|
if (!ret) {
|
asd->params.color_effect = (u32)*effect;
|
return 0;
|
}
|
|
if (*effect == asd->params.color_effect)
|
return 0;
|
|
/*
|
* isp_subdev->params.macc_en should be set to false.
|
*/
|
asd->params.macc_en = false;
|
|
switch (*effect) {
|
case V4L2_COLORFX_NONE:
|
macc_table = &asd->params.css_param.macc_table;
|
asd->params.macc_en = true;
|
break;
|
case V4L2_COLORFX_SEPIA:
|
cc_config = &sepia_cc_config;
|
break;
|
case V4L2_COLORFX_NEGATIVE:
|
cc_config = &nega_cc_config;
|
break;
|
case V4L2_COLORFX_BW:
|
cc_config = &mono_cc_config;
|
break;
|
case V4L2_COLORFX_SKY_BLUE:
|
macc_table = &blue_macc_table;
|
asd->params.macc_en = true;
|
break;
|
case V4L2_COLORFX_GRASS_GREEN:
|
macc_table = &green_macc_table;
|
asd->params.macc_en = true;
|
break;
|
case V4L2_COLORFX_SKIN_WHITEN_LOW:
|
macc_table = &skin_low_macc_table;
|
asd->params.macc_en = true;
|
break;
|
case V4L2_COLORFX_SKIN_WHITEN:
|
macc_table = &skin_medium_macc_table;
|
asd->params.macc_en = true;
|
break;
|
case V4L2_COLORFX_SKIN_WHITEN_HIGH:
|
macc_table = &skin_high_macc_table;
|
asd->params.macc_en = true;
|
break;
|
case V4L2_COLORFX_VIVID:
|
ctc_table = &vivid_ctc_table;
|
break;
|
default:
|
return -EINVAL;
|
}
|
atomisp_update_capture_mode(asd);
|
|
if (cc_config)
|
asd->params.config.cc_config = cc_config;
|
if (macc_table)
|
asd->params.config.macc_table = macc_table;
|
if (ctc_table)
|
atomisp_css_set_ctc_table(asd, ctc_table);
|
asd->params.color_effect = (u32)*effect;
|
asd->params.css_update_params_needed = true;
|
return 0;
|
}
|
|
/*
|
* Function to configure bad pixel correction
|
*/
|
int atomisp_bad_pixel(struct atomisp_sub_device *asd, int flag,
|
__s32 *value)
|
{
|
if (flag == 0) {
|
*value = asd->params.bad_pixel_en;
|
return 0;
|
}
|
asd->params.bad_pixel_en = !!*value;
|
|
return 0;
|
}
|
|
/*
|
* Function to configure bad pixel correction params
|
*/
|
int atomisp_bad_pixel_param(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_dp_config *config)
|
{
|
if (flag == 0) {
|
/* Get bad pixel from current setup */
|
if (atomisp_css_get_dp_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set bad pixel to isp parameters */
|
memcpy(&asd->params.css_param.dp_config, config,
|
sizeof(asd->params.css_param.dp_config));
|
asd->params.config.dp_config = &asd->params.css_param.dp_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to enable/disable video image stablization
|
*/
|
int atomisp_video_stable(struct atomisp_sub_device *asd, int flag,
|
__s32 *value)
|
{
|
if (flag == 0)
|
*value = asd->params.video_dis_en;
|
else
|
asd->params.video_dis_en = !!*value;
|
|
return 0;
|
}
|
|
/*
|
* Function to configure fixed pattern noise
|
*/
|
int atomisp_fixed_pattern(struct atomisp_sub_device *asd, int flag,
|
__s32 *value)
|
{
|
if (flag == 0) {
|
*value = asd->params.fpn_en;
|
return 0;
|
}
|
|
if (*value == 0) {
|
asd->params.fpn_en = false;
|
return 0;
|
}
|
|
/* Add function to get black from from sensor with shutter off */
|
return 0;
|
}
|
|
static unsigned int
|
atomisp_bytesperline_to_padded_width(unsigned int bytesperline,
|
enum ia_css_frame_format format)
|
{
|
switch (format) {
|
case IA_CSS_FRAME_FORMAT_UYVY:
|
case IA_CSS_FRAME_FORMAT_YUYV:
|
case IA_CSS_FRAME_FORMAT_RAW:
|
case IA_CSS_FRAME_FORMAT_RGB565:
|
return bytesperline / 2;
|
case IA_CSS_FRAME_FORMAT_RGBA888:
|
return bytesperline / 4;
|
/* The following cases could be removed, but we leave them
|
in to document the formats that are included. */
|
case IA_CSS_FRAME_FORMAT_NV11:
|
case IA_CSS_FRAME_FORMAT_NV12:
|
case IA_CSS_FRAME_FORMAT_NV16:
|
case IA_CSS_FRAME_FORMAT_NV21:
|
case IA_CSS_FRAME_FORMAT_NV61:
|
case IA_CSS_FRAME_FORMAT_YV12:
|
case IA_CSS_FRAME_FORMAT_YV16:
|
case IA_CSS_FRAME_FORMAT_YUV420:
|
case IA_CSS_FRAME_FORMAT_YUV420_16:
|
case IA_CSS_FRAME_FORMAT_YUV422:
|
case IA_CSS_FRAME_FORMAT_YUV422_16:
|
case IA_CSS_FRAME_FORMAT_YUV444:
|
case IA_CSS_FRAME_FORMAT_YUV_LINE:
|
case IA_CSS_FRAME_FORMAT_PLANAR_RGB888:
|
case IA_CSS_FRAME_FORMAT_QPLANE6:
|
case IA_CSS_FRAME_FORMAT_BINARY_8:
|
default:
|
return bytesperline;
|
}
|
}
|
|
static int
|
atomisp_v4l2_framebuffer_to_css_frame(const struct v4l2_framebuffer *arg,
|
struct ia_css_frame **result)
|
{
|
struct ia_css_frame *res = NULL;
|
unsigned int padded_width;
|
enum ia_css_frame_format sh_format;
|
char *tmp_buf = NULL;
|
int ret = 0;
|
|
sh_format = v4l2_fmt_to_sh_fmt(arg->fmt.pixelformat);
|
padded_width = atomisp_bytesperline_to_padded_width(
|
arg->fmt.bytesperline, sh_format);
|
|
/* Note: the padded width on an ia_css_frame is in elements, not in
|
bytes. The RAW frame we use here should always be a 16bit RAW
|
frame. This is why we bytesperline/2 is equal to the padded with */
|
if (ia_css_frame_allocate(&res, arg->fmt.width, arg->fmt.height,
|
sh_format, padded_width, 0)) {
|
ret = -ENOMEM;
|
goto err;
|
}
|
|
tmp_buf = vmalloc(arg->fmt.sizeimage);
|
if (!tmp_buf) {
|
ret = -ENOMEM;
|
goto err;
|
}
|
if (copy_from_user(tmp_buf, (void __user __force *)arg->base,
|
arg->fmt.sizeimage)) {
|
ret = -EFAULT;
|
goto err;
|
}
|
|
if (hmm_store(res->data, tmp_buf, arg->fmt.sizeimage)) {
|
ret = -EINVAL;
|
goto err;
|
}
|
|
err:
|
if (ret && res)
|
ia_css_frame_free(res);
|
if (tmp_buf)
|
vfree(tmp_buf);
|
if (ret == 0)
|
*result = res;
|
return ret;
|
}
|
|
/*
|
* Function to configure fixed pattern noise table
|
*/
|
int atomisp_fixed_pattern_table(struct atomisp_sub_device *asd,
|
struct v4l2_framebuffer *arg)
|
{
|
struct ia_css_frame *raw_black_frame = NULL;
|
int ret;
|
|
if (!arg)
|
return -EINVAL;
|
|
ret = atomisp_v4l2_framebuffer_to_css_frame(arg, &raw_black_frame);
|
if (ret)
|
return ret;
|
|
if (sh_css_set_black_frame(asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].stream,
|
raw_black_frame) != 0)
|
return -ENOMEM;
|
|
ia_css_frame_free(raw_black_frame);
|
return ret;
|
}
|
|
/*
|
* Function to configure false color correction
|
*/
|
int atomisp_false_color(struct atomisp_sub_device *asd, int flag,
|
__s32 *value)
|
{
|
/* Get nr config from current setup */
|
if (flag == 0) {
|
*value = asd->params.false_color;
|
return 0;
|
}
|
|
/* Set nr config to isp parameters */
|
if (*value) {
|
asd->params.config.de_config = NULL;
|
} else {
|
asd->params.css_param.de_config.pixelnoise = 0;
|
asd->params.config.de_config = &asd->params.css_param.de_config;
|
}
|
asd->params.css_update_params_needed = true;
|
asd->params.false_color = *value;
|
return 0;
|
}
|
|
/*
|
* Function to configure bad pixel correction params
|
*/
|
int atomisp_false_color_param(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_de_config *config)
|
{
|
if (flag == 0) {
|
/* Get false color from current setup */
|
if (atomisp_css_get_de_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set false color to isp parameters */
|
memcpy(&asd->params.css_param.de_config, config,
|
sizeof(asd->params.css_param.de_config));
|
asd->params.config.de_config = &asd->params.css_param.de_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to configure white balance params
|
*/
|
int atomisp_white_balance_param(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_wb_config *config)
|
{
|
if (flag == 0) {
|
/* Get white balance from current setup */
|
if (atomisp_css_get_wb_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set white balance to isp parameters */
|
memcpy(&asd->params.css_param.wb_config, config,
|
sizeof(asd->params.css_param.wb_config));
|
asd->params.config.wb_config = &asd->params.css_param.wb_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
int atomisp_3a_config_param(struct atomisp_sub_device *asd, int flag,
|
struct atomisp_3a_config *config)
|
{
|
struct atomisp_device *isp = asd->isp;
|
|
dev_dbg(isp->dev, ">%s %d\n", __func__, flag);
|
|
if (flag == 0) {
|
/* Get white balance from current setup */
|
if (atomisp_css_get_3a_config(asd, config))
|
return -EINVAL;
|
} else {
|
/* Set white balance to isp parameters */
|
memcpy(&asd->params.css_param.s3a_config, config,
|
sizeof(asd->params.css_param.s3a_config));
|
asd->params.config.s3a_config = &asd->params.css_param.s3a_config;
|
asd->params.css_update_params_needed = true;
|
}
|
|
dev_dbg(isp->dev, "<%s %d\n", __func__, flag);
|
return 0;
|
}
|
|
/*
|
* Function to setup digital zoom
|
*/
|
int atomisp_digital_zoom(struct atomisp_sub_device *asd, int flag,
|
__s32 *value)
|
{
|
u32 zoom;
|
struct atomisp_device *isp = asd->isp;
|
|
unsigned int max_zoom = MRFLD_MAX_ZOOM_FACTOR;
|
|
if (flag == 0) {
|
atomisp_css_get_zoom_factor(asd, &zoom);
|
*value = max_zoom - zoom;
|
} else {
|
if (*value < 0)
|
return -EINVAL;
|
|
zoom = max_zoom - min_t(u32, max_zoom - 1, *value);
|
atomisp_css_set_zoom_factor(asd, zoom);
|
|
dev_dbg(isp->dev, "%s, zoom: %d\n", __func__, zoom);
|
asd->params.css_update_params_needed = true;
|
}
|
|
return 0;
|
}
|
|
/*
|
* Function to get sensor specific info for current resolution,
|
* which will be used for auto exposure conversion.
|
*/
|
int atomisp_get_sensor_mode_data(struct atomisp_sub_device *asd,
|
struct atomisp_sensor_mode_data *config)
|
{
|
struct camera_mipi_info *mipi_info;
|
struct atomisp_device *isp = asd->isp;
|
|
mipi_info = atomisp_to_sensor_mipi_info(
|
isp->inputs[asd->input_curr].camera);
|
if (!mipi_info)
|
return -EINVAL;
|
|
memcpy(config, &mipi_info->data, sizeof(*config));
|
return 0;
|
}
|
|
int atomisp_get_fmt(struct video_device *vdev, struct v4l2_format *f)
|
{
|
struct atomisp_video_pipe *pipe = atomisp_to_video_pipe(vdev);
|
|
f->fmt.pix = pipe->pix;
|
|
return 0;
|
}
|
|
static void __atomisp_update_stream_env(struct atomisp_sub_device *asd,
|
u16 stream_index, struct atomisp_input_stream_info *stream_info)
|
{
|
int i;
|
|
/* assign virtual channel id return from sensor driver query */
|
asd->stream_env[stream_index].ch_id = stream_info->ch_id;
|
asd->stream_env[stream_index].isys_configs = stream_info->isys_configs;
|
for (i = 0; i < stream_info->isys_configs; i++) {
|
asd->stream_env[stream_index].isys_info[i].input_format =
|
stream_info->isys_info[i].input_format;
|
asd->stream_env[stream_index].isys_info[i].width =
|
stream_info->isys_info[i].width;
|
asd->stream_env[stream_index].isys_info[i].height =
|
stream_info->isys_info[i].height;
|
}
|
}
|
|
static void __atomisp_init_stream_info(u16 stream_index,
|
struct atomisp_input_stream_info *stream_info)
|
{
|
int i;
|
|
stream_info->enable = 1;
|
stream_info->stream = stream_index;
|
stream_info->ch_id = 0;
|
stream_info->isys_configs = 0;
|
for (i = 0; i < MAX_STREAMS_PER_CHANNEL; i++) {
|
stream_info->isys_info[i].input_format = 0;
|
stream_info->isys_info[i].width = 0;
|
stream_info->isys_info[i].height = 0;
|
}
|
}
|
|
/* This function looks up the closest available resolution. */
|
int atomisp_try_fmt(struct video_device *vdev, struct v4l2_format *f,
|
bool *res_overflow)
|
{
|
struct atomisp_device *isp = video_get_drvdata(vdev);
|
struct atomisp_sub_device *asd = atomisp_to_video_pipe(vdev)->asd;
|
struct v4l2_subdev_pad_config pad_cfg;
|
struct v4l2_subdev_format format = {
|
.which = V4L2_SUBDEV_FORMAT_TRY,
|
};
|
|
struct v4l2_mbus_framefmt *snr_mbus_fmt = &format.format;
|
const struct atomisp_format_bridge *fmt;
|
struct atomisp_input_stream_info *stream_info =
|
(struct atomisp_input_stream_info *)snr_mbus_fmt->reserved;
|
u16 stream_index;
|
int source_pad = atomisp_subdev_source_pad(vdev);
|
int ret;
|
|
if (!asd) {
|
dev_err(isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, vdev->name);
|
return -EINVAL;
|
}
|
|
if (!isp->inputs[asd->input_curr].camera)
|
return -EINVAL;
|
|
stream_index = atomisp_source_pad_to_stream_id(asd, source_pad);
|
fmt = atomisp_get_format_bridge(f->fmt.pix.pixelformat);
|
if (!fmt) {
|
dev_err(isp->dev, "unsupported pixelformat!\n");
|
fmt = atomisp_output_fmts;
|
}
|
|
if (f->fmt.pix.width <= 0 || f->fmt.pix.height <= 0)
|
return -EINVAL;
|
|
snr_mbus_fmt->code = fmt->mbus_code;
|
snr_mbus_fmt->width = f->fmt.pix.width;
|
snr_mbus_fmt->height = f->fmt.pix.height;
|
|
__atomisp_init_stream_info(stream_index, stream_info);
|
|
dev_dbg(isp->dev, "try_mbus_fmt: asking for %ux%u\n",
|
snr_mbus_fmt->width, snr_mbus_fmt->height);
|
|
ret = v4l2_subdev_call(isp->inputs[asd->input_curr].camera,
|
pad, set_fmt, &pad_cfg, &format);
|
if (ret)
|
return ret;
|
|
dev_dbg(isp->dev, "try_mbus_fmt: got %ux%u\n",
|
snr_mbus_fmt->width, snr_mbus_fmt->height);
|
|
fmt = atomisp_get_format_bridge_from_mbus(snr_mbus_fmt->code);
|
if (!fmt) {
|
dev_err(isp->dev, "unknown sensor format 0x%8.8x\n",
|
snr_mbus_fmt->code);
|
return -EINVAL;
|
}
|
|
f->fmt.pix.pixelformat = fmt->pixelformat;
|
|
/*
|
* If the format is jpeg or custom RAW, then the width and height will
|
* not satisfy the normal atomisp requirements and no need to check
|
* the below conditions. So just assign to what is being returned from
|
* the sensor driver.
|
*/
|
if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_JPEG ||
|
f->fmt.pix.pixelformat == V4L2_PIX_FMT_CUSTOM_M10MO_RAW) {
|
f->fmt.pix.width = snr_mbus_fmt->width;
|
f->fmt.pix.height = snr_mbus_fmt->height;
|
return 0;
|
}
|
|
if (snr_mbus_fmt->width < f->fmt.pix.width
|
&& snr_mbus_fmt->height < f->fmt.pix.height) {
|
f->fmt.pix.width = snr_mbus_fmt->width;
|
f->fmt.pix.height = snr_mbus_fmt->height;
|
/* Set the flag when resolution requested is
|
* beyond the max value supported by sensor
|
*/
|
if (res_overflow)
|
*res_overflow = true;
|
}
|
|
/* app vs isp */
|
f->fmt.pix.width = rounddown(
|
clamp_t(u32, f->fmt.pix.width, ATOM_ISP_MIN_WIDTH,
|
ATOM_ISP_MAX_WIDTH), ATOM_ISP_STEP_WIDTH);
|
f->fmt.pix.height = rounddown(
|
clamp_t(u32, f->fmt.pix.height, ATOM_ISP_MIN_HEIGHT,
|
ATOM_ISP_MAX_HEIGHT), ATOM_ISP_STEP_HEIGHT);
|
|
return 0;
|
}
|
|
static int
|
atomisp_try_fmt_file(struct atomisp_device *isp, struct v4l2_format *f)
|
{
|
u32 width = f->fmt.pix.width;
|
u32 height = f->fmt.pix.height;
|
u32 pixelformat = f->fmt.pix.pixelformat;
|
enum v4l2_field field = f->fmt.pix.field;
|
u32 depth;
|
|
if (!atomisp_get_format_bridge(pixelformat)) {
|
dev_err(isp->dev, "Wrong output pixelformat\n");
|
return -EINVAL;
|
}
|
|
depth = get_pixel_depth(pixelformat);
|
|
if (field == V4L2_FIELD_ANY) {
|
field = V4L2_FIELD_NONE;
|
} else if (field != V4L2_FIELD_NONE) {
|
dev_err(isp->dev, "Wrong output field\n");
|
return -EINVAL;
|
}
|
|
f->fmt.pix.field = field;
|
f->fmt.pix.width = clamp_t(u32,
|
rounddown(width, (u32)ATOM_ISP_STEP_WIDTH),
|
ATOM_ISP_MIN_WIDTH, ATOM_ISP_MAX_WIDTH);
|
f->fmt.pix.height = clamp_t(u32, rounddown(height,
|
(u32)ATOM_ISP_STEP_HEIGHT),
|
ATOM_ISP_MIN_HEIGHT, ATOM_ISP_MAX_HEIGHT);
|
f->fmt.pix.bytesperline = (width * depth) >> 3;
|
|
return 0;
|
}
|
|
enum mipi_port_id __get_mipi_port(struct atomisp_device *isp,
|
enum atomisp_camera_port port)
|
{
|
switch (port) {
|
case ATOMISP_CAMERA_PORT_PRIMARY:
|
return MIPI_PORT0_ID;
|
case ATOMISP_CAMERA_PORT_SECONDARY:
|
return MIPI_PORT1_ID;
|
case ATOMISP_CAMERA_PORT_TERTIARY:
|
if (MIPI_PORT1_ID + 1 != N_MIPI_PORT_ID)
|
return MIPI_PORT1_ID + 1;
|
fallthrough;
|
default:
|
dev_err(isp->dev, "unsupported port: %d\n", port);
|
return MIPI_PORT0_ID;
|
}
|
}
|
|
static inline int atomisp_set_sensor_mipi_to_isp(
|
struct atomisp_sub_device *asd,
|
enum atomisp_input_stream_id stream_id,
|
struct camera_mipi_info *mipi_info)
|
{
|
struct v4l2_control ctrl;
|
struct atomisp_device *isp = asd->isp;
|
const struct atomisp_in_fmt_conv *fc;
|
int mipi_freq = 0;
|
unsigned int input_format, bayer_order;
|
|
ctrl.id = V4L2_CID_LINK_FREQ;
|
if (v4l2_g_ctrl
|
(isp->inputs[asd->input_curr].camera->ctrl_handler, &ctrl) == 0)
|
mipi_freq = ctrl.value;
|
|
if (asd->stream_env[stream_id].isys_configs == 1) {
|
input_format =
|
asd->stream_env[stream_id].isys_info[0].input_format;
|
atomisp_css_isys_set_format(asd, stream_id,
|
input_format, IA_CSS_STREAM_DEFAULT_ISYS_STREAM_IDX);
|
} else if (asd->stream_env[stream_id].isys_configs == 2) {
|
atomisp_css_isys_two_stream_cfg_update_stream1(
|
asd, stream_id,
|
asd->stream_env[stream_id].isys_info[0].input_format,
|
asd->stream_env[stream_id].isys_info[0].width,
|
asd->stream_env[stream_id].isys_info[0].height);
|
|
atomisp_css_isys_two_stream_cfg_update_stream2(
|
asd, stream_id,
|
asd->stream_env[stream_id].isys_info[1].input_format,
|
asd->stream_env[stream_id].isys_info[1].width,
|
asd->stream_env[stream_id].isys_info[1].height);
|
}
|
|
/* Compatibility for sensors which provide no media bus code
|
* in s_mbus_framefmt() nor support pad formats. */
|
if (mipi_info->input_format != -1) {
|
bayer_order = mipi_info->raw_bayer_order;
|
|
/* Input stream config is still needs configured */
|
/* TODO: Check if this is necessary */
|
fc = atomisp_find_in_fmt_conv_by_atomisp_in_fmt(
|
mipi_info->input_format);
|
if (!fc)
|
return -EINVAL;
|
input_format = fc->atomisp_in_fmt;
|
} else {
|
struct v4l2_mbus_framefmt *sink;
|
|
sink = atomisp_subdev_get_ffmt(&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK);
|
fc = atomisp_find_in_fmt_conv(sink->code);
|
if (!fc)
|
return -EINVAL;
|
input_format = fc->atomisp_in_fmt;
|
bayer_order = fc->bayer_order;
|
}
|
|
atomisp_css_input_set_format(asd, stream_id, input_format);
|
atomisp_css_input_set_bayer_order(asd, stream_id, bayer_order);
|
|
fc = atomisp_find_in_fmt_conv_by_atomisp_in_fmt(
|
mipi_info->metadata_format);
|
if (!fc)
|
return -EINVAL;
|
input_format = fc->atomisp_in_fmt;
|
atomisp_css_input_configure_port(asd,
|
__get_mipi_port(asd->isp, mipi_info->port),
|
mipi_info->num_lanes,
|
0xffff4, mipi_freq,
|
input_format,
|
mipi_info->metadata_width,
|
mipi_info->metadata_height);
|
return 0;
|
}
|
|
static int __enable_continuous_mode(struct atomisp_sub_device *asd,
|
bool enable)
|
{
|
struct atomisp_device *isp = asd->isp;
|
|
dev_dbg(isp->dev,
|
"continuous mode %d, raw buffers %d, stop preview %d\n",
|
enable, asd->continuous_raw_buffer_size->val,
|
!asd->continuous_viewfinder->val);
|
|
if (!IS_ISP2401)
|
atomisp_css_capture_set_mode(asd, IA_CSS_CAPTURE_MODE_PRIMARY);
|
else
|
atomisp_update_capture_mode(asd);
|
|
/* in case of ANR, force capture pipe to offline mode */
|
atomisp_css_capture_enable_online(asd, ATOMISP_INPUT_STREAM_GENERAL,
|
asd->params.low_light ? false : !enable);
|
atomisp_css_preview_enable_online(asd, ATOMISP_INPUT_STREAM_GENERAL,
|
!enable);
|
atomisp_css_enable_continuous(asd, enable);
|
atomisp_css_enable_cvf(asd, asd->continuous_viewfinder->val);
|
|
if (atomisp_css_continuous_set_num_raw_frames(asd,
|
asd->continuous_raw_buffer_size->val)) {
|
dev_err(isp->dev, "css_continuous_set_num_raw_frames failed\n");
|
return -EINVAL;
|
}
|
|
if (!enable) {
|
atomisp_css_enable_raw_binning(asd, false);
|
atomisp_css_input_set_two_pixels_per_clock(asd, false);
|
}
|
|
if (isp->inputs[asd->input_curr].type != FILE_INPUT)
|
atomisp_css_input_set_mode(asd, IA_CSS_INPUT_MODE_BUFFERED_SENSOR);
|
|
return atomisp_update_run_mode(asd);
|
}
|
|
static int configure_pp_input_nop(struct atomisp_sub_device *asd,
|
unsigned int width, unsigned int height)
|
{
|
return 0;
|
}
|
|
static int configure_output_nop(struct atomisp_sub_device *asd,
|
unsigned int width, unsigned int height,
|
unsigned int min_width,
|
enum ia_css_frame_format sh_fmt)
|
{
|
return 0;
|
}
|
|
static int get_frame_info_nop(struct atomisp_sub_device *asd,
|
struct ia_css_frame_info *finfo)
|
{
|
return 0;
|
}
|
|
/*
|
* Resets CSS parameters that depend on input resolution.
|
*
|
* Update params like CSS RAW binning, 2ppc mode and pp_input
|
* which depend on input size, but are not automatically
|
* handled in CSS when the input resolution is changed.
|
*/
|
static int css_input_resolution_changed(struct atomisp_sub_device *asd,
|
struct v4l2_mbus_framefmt *ffmt)
|
{
|
struct atomisp_metadata_buf *md_buf = NULL, *_md_buf;
|
unsigned int i;
|
|
dev_dbg(asd->isp->dev, "css_input_resolution_changed to %ux%u\n",
|
ffmt->width, ffmt->height);
|
|
#if defined(ISP2401_NEW_INPUT_SYSTEM)
|
atomisp_css_input_set_two_pixels_per_clock(asd, false);
|
#else
|
atomisp_css_input_set_two_pixels_per_clock(asd, true);
|
#endif
|
if (asd->continuous_mode->val) {
|
/* Note for all checks: ffmt includes pad_w+pad_h */
|
if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO ||
|
(ffmt->width >= 2048 || ffmt->height >= 1536)) {
|
/*
|
* For preview pipe, enable only if resolution
|
* is >= 3M for ISP2400.
|
*/
|
atomisp_css_enable_raw_binning(asd, true);
|
}
|
}
|
/*
|
* If sensor input changed, which means metadata resolution changed
|
* together. Release all metadata buffers here to let it re-allocated
|
* next time in reqbufs.
|
*/
|
for (i = 0; i < ATOMISP_METADATA_TYPE_NUM; i++) {
|
list_for_each_entry_safe(md_buf, _md_buf, &asd->metadata[i],
|
list) {
|
atomisp_css_free_metadata_buffer(md_buf);
|
list_del(&md_buf->list);
|
kfree(md_buf);
|
}
|
}
|
return 0;
|
|
/*
|
* TODO: atomisp_css_preview_configure_pp_input() not
|
* reset due to CSS bug tracked as PSI BZ 115124
|
*/
|
}
|
|
static int atomisp_set_fmt_to_isp(struct video_device *vdev,
|
struct ia_css_frame_info *output_info,
|
struct ia_css_frame_info *raw_output_info,
|
struct v4l2_pix_format *pix,
|
unsigned int source_pad)
|
{
|
struct camera_mipi_info *mipi_info;
|
struct atomisp_device *isp = video_get_drvdata(vdev);
|
struct atomisp_sub_device *asd = atomisp_to_video_pipe(vdev)->asd;
|
const struct atomisp_format_bridge *format;
|
struct v4l2_rect *isp_sink_crop;
|
enum ia_css_pipe_id pipe_id;
|
struct v4l2_subdev_fh fh;
|
int (*configure_output)(struct atomisp_sub_device *asd,
|
unsigned int width, unsigned int height,
|
unsigned int min_width,
|
enum ia_css_frame_format sh_fmt) =
|
configure_output_nop;
|
int (*get_frame_info)(struct atomisp_sub_device *asd,
|
struct ia_css_frame_info *finfo) =
|
get_frame_info_nop;
|
int (*configure_pp_input)(struct atomisp_sub_device *asd,
|
unsigned int width, unsigned int height) =
|
configure_pp_input_nop;
|
u16 stream_index;
|
const struct atomisp_in_fmt_conv *fc;
|
int ret, i;
|
|
if (!asd) {
|
dev_err(isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, vdev->name);
|
return -EINVAL;
|
}
|
stream_index = atomisp_source_pad_to_stream_id(asd, source_pad);
|
|
v4l2_fh_init(&fh.vfh, vdev);
|
|
isp_sink_crop = atomisp_subdev_get_rect(
|
&asd->subdev, NULL, V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK, V4L2_SEL_TGT_CROP);
|
|
format = atomisp_get_format_bridge(pix->pixelformat);
|
if (!format)
|
return -EINVAL;
|
|
if (isp->inputs[asd->input_curr].type != TEST_PATTERN &&
|
isp->inputs[asd->input_curr].type != FILE_INPUT) {
|
mipi_info = atomisp_to_sensor_mipi_info(
|
isp->inputs[asd->input_curr].camera);
|
if (!mipi_info) {
|
dev_err(isp->dev, "mipi_info is NULL\n");
|
return -EINVAL;
|
}
|
if (atomisp_set_sensor_mipi_to_isp(asd, stream_index,
|
mipi_info))
|
return -EINVAL;
|
fc = atomisp_find_in_fmt_conv_by_atomisp_in_fmt(
|
mipi_info->input_format);
|
if (!fc)
|
fc = atomisp_find_in_fmt_conv(
|
atomisp_subdev_get_ffmt(&asd->subdev,
|
NULL, V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK)->code);
|
if (!fc)
|
return -EINVAL;
|
if (format->sh_fmt == IA_CSS_FRAME_FORMAT_RAW &&
|
raw_output_format_match_input(fc->atomisp_in_fmt,
|
pix->pixelformat))
|
return -EINVAL;
|
}
|
|
/*
|
* Configure viewfinder also when vfpp is disabled: the
|
* CSS still requires viewfinder configuration.
|
*/
|
if (asd->fmt_auto->val ||
|
asd->vfpp->val != ATOMISP_VFPP_ENABLE) {
|
struct v4l2_rect vf_size = {0};
|
struct v4l2_mbus_framefmt vf_ffmt = {0};
|
|
if (pix->width < 640 || pix->height < 480) {
|
vf_size.width = pix->width;
|
vf_size.height = pix->height;
|
} else {
|
vf_size.width = 640;
|
vf_size.height = 480;
|
}
|
|
/* FIXME: proper format name for this one. See
|
atomisp_output_fmts[] in atomisp_v4l2.c */
|
vf_ffmt.code = V4L2_MBUS_FMT_CUSTOM_YUV420;
|
|
atomisp_subdev_set_selection(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SOURCE_VF,
|
V4L2_SEL_TGT_COMPOSE, 0, &vf_size);
|
atomisp_subdev_set_ffmt(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SOURCE_VF, &vf_ffmt);
|
asd->video_out_vf.sh_fmt = IA_CSS_FRAME_FORMAT_NV12;
|
|
if (asd->vfpp->val == ATOMISP_VFPP_DISABLE_SCALER) {
|
atomisp_css_video_configure_viewfinder(asd,
|
vf_size.width, vf_size.height, 0,
|
asd->video_out_vf.sh_fmt);
|
} else if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO) {
|
if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW ||
|
source_pad == ATOMISP_SUBDEV_PAD_SOURCE_VIDEO)
|
atomisp_css_video_configure_viewfinder(asd,
|
vf_size.width, vf_size.height, 0,
|
asd->video_out_vf.sh_fmt);
|
else
|
atomisp_css_capture_configure_viewfinder(asd,
|
vf_size.width, vf_size.height, 0,
|
asd->video_out_vf.sh_fmt);
|
} else if (source_pad != ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW ||
|
asd->vfpp->val == ATOMISP_VFPP_DISABLE_LOWLAT) {
|
atomisp_css_capture_configure_viewfinder(asd,
|
vf_size.width, vf_size.height, 0,
|
asd->video_out_vf.sh_fmt);
|
}
|
}
|
|
if (asd->continuous_mode->val) {
|
ret = __enable_continuous_mode(asd, true);
|
if (ret)
|
return -EINVAL;
|
}
|
|
atomisp_css_input_set_mode(asd, IA_CSS_INPUT_MODE_BUFFERED_SENSOR);
|
|
for (i = 0; i < IA_CSS_PIPE_ID_NUM; i++)
|
asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].pipe_extra_configs[i].disable_vf_pp = asd->vfpp->val != ATOMISP_VFPP_ENABLE;
|
|
/* ISP2401 new input system need to use copy pipe */
|
if (asd->copy_mode) {
|
pipe_id = IA_CSS_PIPE_ID_COPY;
|
atomisp_css_capture_enable_online(asd, stream_index, false);
|
} else if (asd->vfpp->val == ATOMISP_VFPP_DISABLE_SCALER) {
|
/* video same in continuouscapture and online modes */
|
configure_output = atomisp_css_video_configure_output;
|
get_frame_info = atomisp_css_video_get_output_frame_info;
|
pipe_id = IA_CSS_PIPE_ID_VIDEO;
|
} else if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO) {
|
if (!asd->continuous_mode->val) {
|
configure_output = atomisp_css_video_configure_output;
|
get_frame_info =
|
atomisp_css_video_get_output_frame_info;
|
pipe_id = IA_CSS_PIPE_ID_VIDEO;
|
} else {
|
if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW ||
|
source_pad == ATOMISP_SUBDEV_PAD_SOURCE_VIDEO) {
|
configure_output =
|
atomisp_css_video_configure_output;
|
get_frame_info =
|
atomisp_css_video_get_output_frame_info;
|
configure_pp_input =
|
atomisp_css_video_configure_pp_input;
|
pipe_id = IA_CSS_PIPE_ID_VIDEO;
|
} else {
|
configure_output =
|
atomisp_css_capture_configure_output;
|
get_frame_info =
|
atomisp_css_capture_get_output_frame_info;
|
configure_pp_input =
|
atomisp_css_capture_configure_pp_input;
|
pipe_id = IA_CSS_PIPE_ID_CAPTURE;
|
|
atomisp_update_capture_mode(asd);
|
atomisp_css_capture_enable_online(asd, stream_index, false);
|
}
|
}
|
} else if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW) {
|
configure_output = atomisp_css_preview_configure_output;
|
get_frame_info = atomisp_css_preview_get_output_frame_info;
|
configure_pp_input = atomisp_css_preview_configure_pp_input;
|
pipe_id = IA_CSS_PIPE_ID_PREVIEW;
|
} else {
|
/* CSS doesn't support low light mode on SOC cameras, so disable
|
* it. FIXME: if this is done elsewhere, it gives corrupted
|
* colors into thumbnail image.
|
*/
|
if (isp->inputs[asd->input_curr].type == SOC_CAMERA)
|
asd->params.low_light = false;
|
|
if (format->sh_fmt == IA_CSS_FRAME_FORMAT_RAW) {
|
atomisp_css_capture_set_mode(asd, IA_CSS_CAPTURE_MODE_RAW);
|
atomisp_css_enable_dz(asd, false);
|
} else {
|
atomisp_update_capture_mode(asd);
|
}
|
|
if (!asd->continuous_mode->val)
|
/* in case of ANR, force capture pipe to offline mode */
|
atomisp_css_capture_enable_online(asd, stream_index,
|
asd->params.low_light ?
|
false : asd->params.online_process);
|
|
configure_output = atomisp_css_capture_configure_output;
|
get_frame_info = atomisp_css_capture_get_output_frame_info;
|
configure_pp_input = atomisp_css_capture_configure_pp_input;
|
pipe_id = IA_CSS_PIPE_ID_CAPTURE;
|
|
if (!asd->params.online_process &&
|
!asd->continuous_mode->val) {
|
ret = atomisp_css_capture_get_output_raw_frame_info(asd,
|
raw_output_info);
|
if (ret)
|
return ret;
|
}
|
if (!asd->continuous_mode->val && asd->run_mode->val
|
!= ATOMISP_RUN_MODE_STILL_CAPTURE) {
|
dev_err(isp->dev,
|
"Need to set the running mode first\n");
|
asd->run_mode->val = ATOMISP_RUN_MODE_STILL_CAPTURE;
|
}
|
}
|
|
/*
|
* to SOC camera, use yuvpp pipe.
|
*/
|
if (ATOMISP_USE_YUVPP(asd))
|
pipe_id = IA_CSS_PIPE_ID_YUVPP;
|
|
if (asd->copy_mode)
|
ret = atomisp_css_copy_configure_output(asd, stream_index,
|
pix->width, pix->height,
|
format->planar ? pix->bytesperline :
|
pix->bytesperline * 8 / format->depth,
|
format->sh_fmt);
|
else
|
ret = configure_output(asd, pix->width, pix->height,
|
format->planar ? pix->bytesperline :
|
pix->bytesperline * 8 / format->depth,
|
format->sh_fmt);
|
if (ret) {
|
dev_err(isp->dev, "configure_output %ux%u, format %8.8x\n",
|
pix->width, pix->height, format->sh_fmt);
|
return -EINVAL;
|
}
|
|
if (asd->continuous_mode->val &&
|
(configure_pp_input == atomisp_css_preview_configure_pp_input ||
|
configure_pp_input == atomisp_css_video_configure_pp_input)) {
|
/* for isp 2.2, configure pp input is available for continuous
|
* mode */
|
ret = configure_pp_input(asd, isp_sink_crop->width,
|
isp_sink_crop->height);
|
if (ret) {
|
dev_err(isp->dev, "configure_pp_input %ux%u\n",
|
isp_sink_crop->width,
|
isp_sink_crop->height);
|
return -EINVAL;
|
}
|
} else {
|
ret = configure_pp_input(asd, isp_sink_crop->width,
|
isp_sink_crop->height);
|
if (ret) {
|
dev_err(isp->dev, "configure_pp_input %ux%u\n",
|
isp_sink_crop->width, isp_sink_crop->height);
|
return -EINVAL;
|
}
|
}
|
if (asd->copy_mode)
|
ret = atomisp_css_copy_get_output_frame_info(asd, stream_index,
|
output_info);
|
else
|
ret = get_frame_info(asd, output_info);
|
if (ret) {
|
dev_err(isp->dev, "get_frame_info %ux%u (padded to %u)\n",
|
pix->width, pix->height, pix->bytesperline);
|
return -EINVAL;
|
}
|
|
atomisp_update_grid_info(asd, pipe_id, source_pad);
|
|
/* Free the raw_dump buffer first */
|
ia_css_frame_free(asd->raw_output_frame);
|
asd->raw_output_frame = NULL;
|
|
if (!asd->continuous_mode->val &&
|
!asd->params.online_process && !isp->sw_contex.file_input &&
|
ia_css_frame_allocate_from_info(&asd->raw_output_frame,
|
raw_output_info))
|
return -ENOMEM;
|
|
return 0;
|
}
|
|
static void atomisp_get_dis_envelop(struct atomisp_sub_device *asd,
|
unsigned int width, unsigned int height,
|
unsigned int *dvs_env_w, unsigned int *dvs_env_h)
|
{
|
struct atomisp_device *isp = asd->isp;
|
|
/* if subdev type is SOC camera,we do not need to set DVS */
|
if (isp->inputs[asd->input_curr].type == SOC_CAMERA)
|
asd->params.video_dis_en = false;
|
|
if (asd->params.video_dis_en &&
|
asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO) {
|
/* envelope is 20% of the output resolution */
|
/*
|
* dvs envelope cannot be round up.
|
* it would cause ISP timeout and color switch issue
|
*/
|
*dvs_env_w = rounddown(width / 5, ATOM_ISP_STEP_WIDTH);
|
*dvs_env_h = rounddown(height / 5, ATOM_ISP_STEP_HEIGHT);
|
}
|
|
asd->params.dis_proj_data_valid = false;
|
asd->params.css_update_params_needed = true;
|
}
|
|
static void atomisp_check_copy_mode(struct atomisp_sub_device *asd,
|
int source_pad, struct v4l2_format *f)
|
{
|
#if defined(ISP2401_NEW_INPUT_SYSTEM)
|
struct v4l2_mbus_framefmt *sink, *src;
|
|
sink = atomisp_subdev_get_ffmt(&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE, ATOMISP_SUBDEV_PAD_SINK);
|
src = atomisp_subdev_get_ffmt(&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE, source_pad);
|
|
if ((sink->code == src->code &&
|
sink->width == f->fmt.pix.width &&
|
sink->height == f->fmt.pix.height) ||
|
((asd->isp->inputs[asd->input_curr].type == SOC_CAMERA) &&
|
(asd->isp->inputs[asd->input_curr].camera_caps->
|
sensor[asd->sensor_curr].stream_num > 1)))
|
asd->copy_mode = true;
|
else
|
#endif
|
/* Only used for the new input system */
|
asd->copy_mode = false;
|
|
dev_dbg(asd->isp->dev, "copy_mode: %d\n", asd->copy_mode);
|
}
|
|
static int atomisp_set_fmt_to_snr(struct video_device *vdev,
|
struct v4l2_format *f, unsigned int pixelformat,
|
unsigned int padding_w, unsigned int padding_h,
|
unsigned int dvs_env_w, unsigned int dvs_env_h)
|
{
|
struct atomisp_sub_device *asd = atomisp_to_video_pipe(vdev)->asd;
|
struct atomisp_video_pipe *pipe = atomisp_to_video_pipe(vdev);
|
const struct atomisp_format_bridge *format;
|
struct v4l2_subdev_pad_config pad_cfg;
|
struct v4l2_subdev_format vformat = {
|
.which = V4L2_SUBDEV_FORMAT_TRY,
|
};
|
struct v4l2_mbus_framefmt *ffmt = &vformat.format;
|
struct v4l2_mbus_framefmt *req_ffmt;
|
struct atomisp_device *isp = asd->isp;
|
struct atomisp_input_stream_info *stream_info =
|
(struct atomisp_input_stream_info *)ffmt->reserved;
|
u16 stream_index = ATOMISP_INPUT_STREAM_GENERAL;
|
int source_pad = atomisp_subdev_source_pad(vdev);
|
struct v4l2_subdev_fh fh;
|
int ret;
|
|
if (!asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, vdev->name);
|
return -EINVAL;
|
}
|
|
v4l2_fh_init(&fh.vfh, vdev);
|
|
stream_index = atomisp_source_pad_to_stream_id(asd, source_pad);
|
|
format = atomisp_get_format_bridge(pixelformat);
|
if (!format)
|
return -EINVAL;
|
|
v4l2_fill_mbus_format(ffmt, &f->fmt.pix, format->mbus_code);
|
ffmt->height += padding_h + dvs_env_h;
|
ffmt->width += padding_w + dvs_env_w;
|
|
dev_dbg(isp->dev, "s_mbus_fmt: ask %ux%u (padding %ux%u, dvs %ux%u)\n",
|
ffmt->width, ffmt->height, padding_w, padding_h,
|
dvs_env_w, dvs_env_h);
|
|
__atomisp_init_stream_info(stream_index, stream_info);
|
|
req_ffmt = ffmt;
|
|
/* Disable dvs if resolution can't be supported by sensor */
|
if (asd->params.video_dis_en &&
|
source_pad == ATOMISP_SUBDEV_PAD_SOURCE_VIDEO) {
|
vformat.which = V4L2_SUBDEV_FORMAT_TRY;
|
ret = v4l2_subdev_call(isp->inputs[asd->input_curr].camera,
|
pad, set_fmt, &pad_cfg, &vformat);
|
if (ret)
|
return ret;
|
if (ffmt->width < req_ffmt->width ||
|
ffmt->height < req_ffmt->height) {
|
req_ffmt->height -= dvs_env_h;
|
req_ffmt->width -= dvs_env_w;
|
ffmt = req_ffmt;
|
dev_warn(isp->dev,
|
"can not enable video dis due to sensor limitation.");
|
asd->params.video_dis_en = false;
|
}
|
}
|
dev_dbg(isp->dev, "sensor width: %d, height: %d\n",
|
ffmt->width, ffmt->height);
|
vformat.which = V4L2_SUBDEV_FORMAT_ACTIVE;
|
ret = v4l2_subdev_call(isp->inputs[asd->input_curr].camera, pad,
|
set_fmt, NULL, &vformat);
|
if (ret)
|
return ret;
|
|
__atomisp_update_stream_env(asd, stream_index, stream_info);
|
|
dev_dbg(isp->dev, "sensor width: %d, height: %d\n",
|
ffmt->width, ffmt->height);
|
|
if (ffmt->width < ATOM_ISP_STEP_WIDTH ||
|
ffmt->height < ATOM_ISP_STEP_HEIGHT)
|
return -EINVAL;
|
|
if (asd->params.video_dis_en &&
|
source_pad == ATOMISP_SUBDEV_PAD_SOURCE_VIDEO &&
|
(ffmt->width < req_ffmt->width || ffmt->height < req_ffmt->height)) {
|
dev_warn(isp->dev,
|
"can not enable video dis due to sensor limitation.");
|
asd->params.video_dis_en = false;
|
}
|
|
atomisp_subdev_set_ffmt(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK, ffmt);
|
|
return css_input_resolution_changed(asd, ffmt);
|
}
|
|
int atomisp_set_fmt(struct video_device *vdev, struct v4l2_format *f)
|
{
|
struct atomisp_device *isp = video_get_drvdata(vdev);
|
struct atomisp_video_pipe *pipe = atomisp_to_video_pipe(vdev);
|
struct atomisp_sub_device *asd = pipe->asd;
|
const struct atomisp_format_bridge *format_bridge;
|
const struct atomisp_format_bridge *snr_format_bridge;
|
struct ia_css_frame_info output_info, raw_output_info;
|
struct v4l2_format snr_fmt = *f;
|
struct v4l2_format backup_fmt = *f, s_fmt = *f;
|
unsigned int dvs_env_w = 0, dvs_env_h = 0;
|
unsigned int padding_w = pad_w, padding_h = pad_h;
|
bool res_overflow = false, crop_needs_override = false;
|
struct v4l2_mbus_framefmt *isp_sink_fmt;
|
struct v4l2_mbus_framefmt isp_source_fmt = {0};
|
struct v4l2_rect isp_sink_crop;
|
u16 source_pad = atomisp_subdev_source_pad(vdev);
|
struct v4l2_subdev_fh fh;
|
int ret;
|
|
if (!asd) {
|
dev_err(isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, vdev->name);
|
return -EINVAL;
|
}
|
|
if (source_pad >= ATOMISP_SUBDEV_PADS_NUM)
|
return -EINVAL;
|
|
if (asd->streaming == ATOMISP_DEVICE_STREAMING_ENABLED) {
|
dev_warn(isp->dev, "ISP does not support set format while at streaming!\n");
|
return -EBUSY;
|
}
|
|
dev_dbg(isp->dev,
|
"setting resolution %ux%u on pad %u for asd%d, bytesperline %u\n",
|
f->fmt.pix.width, f->fmt.pix.height, source_pad,
|
asd->index, f->fmt.pix.bytesperline);
|
|
v4l2_fh_init(&fh.vfh, vdev);
|
|
format_bridge = atomisp_get_format_bridge(f->fmt.pix.pixelformat);
|
if (!format_bridge)
|
return -EINVAL;
|
|
pipe->sh_fmt = format_bridge->sh_fmt;
|
pipe->pix.pixelformat = f->fmt.pix.pixelformat;
|
|
if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_VF ||
|
(source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW
|
&& asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO)) {
|
if (asd->fmt_auto->val) {
|
struct v4l2_rect *capture_comp;
|
struct v4l2_rect r = {0};
|
|
r.width = f->fmt.pix.width;
|
r.height = f->fmt.pix.height;
|
|
if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW)
|
capture_comp = atomisp_subdev_get_rect(
|
&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SOURCE_VIDEO,
|
V4L2_SEL_TGT_COMPOSE);
|
else
|
capture_comp = atomisp_subdev_get_rect(
|
&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SOURCE_CAPTURE,
|
V4L2_SEL_TGT_COMPOSE);
|
|
if (capture_comp->width < r.width
|
|| capture_comp->height < r.height) {
|
r.width = capture_comp->width;
|
r.height = capture_comp->height;
|
}
|
|
atomisp_subdev_set_selection(
|
&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE, source_pad,
|
V4L2_SEL_TGT_COMPOSE, 0, &r);
|
|
f->fmt.pix.width = r.width;
|
f->fmt.pix.height = r.height;
|
}
|
|
if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW &&
|
(asd->isp->inputs[asd->input_curr].type == SOC_CAMERA) &&
|
(asd->isp->inputs[asd->input_curr].camera_caps->
|
sensor[asd->sensor_curr].stream_num > 1)) {
|
/* For M10MO outputing YUV preview images. */
|
u16 video_index =
|
atomisp_source_pad_to_stream_id(asd,
|
ATOMISP_SUBDEV_PAD_SOURCE_VIDEO);
|
|
ret = atomisp_css_copy_get_output_frame_info(asd,
|
video_index, &output_info);
|
if (ret) {
|
dev_err(isp->dev,
|
"copy_get_output_frame_info ret %i", ret);
|
return -EINVAL;
|
}
|
if (!asd->yuvpp_mode) {
|
/*
|
* If viewfinder was configured into copy_mode,
|
* we switch to using yuvpp pipe instead.
|
*/
|
asd->yuvpp_mode = true;
|
ret = atomisp_css_copy_configure_output(
|
asd, video_index, 0, 0, 0, 0);
|
if (ret) {
|
dev_err(isp->dev,
|
"failed to disable copy pipe");
|
return -EINVAL;
|
}
|
ret = atomisp_css_yuvpp_configure_output(
|
asd, video_index,
|
output_info.res.width,
|
output_info.res.height,
|
output_info.padded_width,
|
output_info.format);
|
if (ret) {
|
dev_err(isp->dev,
|
"failed to set up yuvpp pipe\n");
|
return -EINVAL;
|
}
|
atomisp_css_video_enable_online(asd, false);
|
atomisp_css_preview_enable_online(asd,
|
ATOMISP_INPUT_STREAM_GENERAL, false);
|
}
|
atomisp_css_yuvpp_configure_viewfinder(asd, video_index,
|
f->fmt.pix.width, f->fmt.pix.height,
|
format_bridge->planar ? f->fmt.pix.bytesperline
|
: f->fmt.pix.bytesperline * 8
|
/ format_bridge->depth, format_bridge->sh_fmt);
|
atomisp_css_yuvpp_get_viewfinder_frame_info(
|
asd, video_index, &output_info);
|
} else if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW) {
|
atomisp_css_video_configure_viewfinder(asd,
|
f->fmt.pix.width, f->fmt.pix.height,
|
format_bridge->planar ? f->fmt.pix.bytesperline
|
: f->fmt.pix.bytesperline * 8
|
/ format_bridge->depth, format_bridge->sh_fmt);
|
atomisp_css_video_get_viewfinder_frame_info(asd,
|
&output_info);
|
asd->copy_mode = false;
|
} else {
|
atomisp_css_capture_configure_viewfinder(asd,
|
f->fmt.pix.width, f->fmt.pix.height,
|
format_bridge->planar ? f->fmt.pix.bytesperline
|
: f->fmt.pix.bytesperline * 8
|
/ format_bridge->depth, format_bridge->sh_fmt);
|
atomisp_css_capture_get_viewfinder_frame_info(asd,
|
&output_info);
|
asd->copy_mode = false;
|
}
|
|
goto done;
|
}
|
/*
|
* Check whether main resolution configured smaller
|
* than snapshot resolution. If so, force main resolution
|
* to be the same as snapshot resolution
|
*/
|
if (source_pad == ATOMISP_SUBDEV_PAD_SOURCE_CAPTURE) {
|
struct v4l2_rect *r;
|
|
r = atomisp_subdev_get_rect(
|
&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SOURCE_VF, V4L2_SEL_TGT_COMPOSE);
|
|
if (r->width && r->height
|
&& (r->width > f->fmt.pix.width
|
|| r->height > f->fmt.pix.height))
|
dev_warn(isp->dev,
|
"Main Resolution config smaller then Vf Resolution. Force to be equal with Vf Resolution.");
|
}
|
|
/* Pipeline configuration done through subdevs. Bail out now. */
|
if (!asd->fmt_auto->val)
|
goto set_fmt_to_isp;
|
|
/* get sensor resolution and format */
|
ret = atomisp_try_fmt(vdev, &snr_fmt, &res_overflow);
|
if (ret) {
|
dev_warn(isp->dev, "Try format failed with error %d\n", ret);
|
return ret;
|
}
|
f->fmt.pix.width = snr_fmt.fmt.pix.width;
|
f->fmt.pix.height = snr_fmt.fmt.pix.height;
|
|
snr_format_bridge =
|
atomisp_get_format_bridge(snr_fmt.fmt.pix.pixelformat);
|
if (!snr_format_bridge) {
|
dev_warn(isp->dev, "Can't find bridge format\n");
|
return -EINVAL;
|
}
|
|
atomisp_subdev_get_ffmt(&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK)->code =
|
snr_format_bridge->mbus_code;
|
|
isp_sink_fmt = atomisp_subdev_get_ffmt(&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK);
|
|
isp_source_fmt.code = format_bridge->mbus_code;
|
atomisp_subdev_set_ffmt(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
source_pad, &isp_source_fmt);
|
|
if (!atomisp_subdev_format_conversion(asd, source_pad)) {
|
padding_w = 0;
|
padding_h = 0;
|
} else if (IS_BYT) {
|
padding_w = 12;
|
padding_h = 12;
|
}
|
|
/* construct resolution supported by isp */
|
if (res_overflow && !asd->continuous_mode->val) {
|
f->fmt.pix.width = rounddown(
|
clamp_t(u32, f->fmt.pix.width - padding_w,
|
ATOM_ISP_MIN_WIDTH,
|
ATOM_ISP_MAX_WIDTH), ATOM_ISP_STEP_WIDTH);
|
f->fmt.pix.height = rounddown(
|
clamp_t(u32, f->fmt.pix.height - padding_h,
|
ATOM_ISP_MIN_HEIGHT,
|
ATOM_ISP_MAX_HEIGHT), ATOM_ISP_STEP_HEIGHT);
|
}
|
|
atomisp_get_dis_envelop(asd, f->fmt.pix.width, f->fmt.pix.height,
|
&dvs_env_w, &dvs_env_h);
|
|
if (asd->continuous_mode->val) {
|
struct v4l2_rect *r;
|
|
r = atomisp_subdev_get_rect(
|
&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SOURCE_CAPTURE,
|
V4L2_SEL_TGT_COMPOSE);
|
/*
|
* The ATOMISP_SUBDEV_PAD_SOURCE_CAPTURE should get resolutions
|
* properly set otherwise, it should not be the capture_pad.
|
*/
|
if (r->width && r->height)
|
asd->capture_pad = ATOMISP_SUBDEV_PAD_SOURCE_CAPTURE;
|
else
|
asd->capture_pad = source_pad;
|
} else {
|
asd->capture_pad = source_pad;
|
}
|
/*
|
* set format info to sensor
|
* In continuous mode, resolution is set only if it is higher than
|
* existing value. This because preview pipe will be configured after
|
* capture pipe and usually has lower resolution than capture pipe.
|
*/
|
if (!asd->continuous_mode->val ||
|
isp_sink_fmt->width < (f->fmt.pix.width + padding_w + dvs_env_w) ||
|
isp_sink_fmt->height < (f->fmt.pix.height + padding_h +
|
dvs_env_h)) {
|
/*
|
* For jpeg or custom raw format the sensor will return constant
|
* width and height. Because we already had quried try_mbus_fmt,
|
* f->fmt.pix.width and f->fmt.pix.height has been changed to
|
* this fixed width and height. So we cannot select the correct
|
* resolution with that information. So use the original width
|
* and height while set_mbus_fmt() so actual resolutions are
|
* being used in while set media bus format.
|
*/
|
s_fmt = *f;
|
if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_JPEG ||
|
f->fmt.pix.pixelformat == V4L2_PIX_FMT_CUSTOM_M10MO_RAW) {
|
s_fmt.fmt.pix.width = backup_fmt.fmt.pix.width;
|
s_fmt.fmt.pix.height = backup_fmt.fmt.pix.height;
|
}
|
ret = atomisp_set_fmt_to_snr(vdev, &s_fmt,
|
f->fmt.pix.pixelformat, padding_w,
|
padding_h, dvs_env_w, dvs_env_h);
|
if (ret) {
|
dev_warn(isp->dev,
|
"Set format to sensor failed with %d\n", ret);
|
return -EINVAL;
|
}
|
|
atomisp_csi_lane_config(isp);
|
crop_needs_override = true;
|
}
|
|
atomisp_check_copy_mode(asd, source_pad, &backup_fmt);
|
asd->yuvpp_mode = false; /* Reset variable */
|
|
isp_sink_crop = *atomisp_subdev_get_rect(&asd->subdev, NULL,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK,
|
V4L2_SEL_TGT_CROP);
|
|
/* Try to enable YUV downscaling if ISP input is 10 % (either
|
* width or height) bigger than the desired result. */
|
if (isp_sink_crop.width * 9 / 10 < f->fmt.pix.width ||
|
isp_sink_crop.height * 9 / 10 < f->fmt.pix.height ||
|
(atomisp_subdev_format_conversion(asd, source_pad) &&
|
((asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO &&
|
!asd->continuous_mode->val) ||
|
asd->vfpp->val == ATOMISP_VFPP_DISABLE_SCALER))) {
|
/* for continuous mode, preview size might be smaller than
|
* still capture size. if preview size still needs crop,
|
* pick the larger one between crop size of preview and
|
* still capture.
|
*/
|
if (asd->continuous_mode->val
|
&& source_pad == ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW
|
&& !crop_needs_override) {
|
isp_sink_crop.width =
|
max_t(unsigned int, f->fmt.pix.width,
|
isp_sink_crop.width);
|
isp_sink_crop.height =
|
max_t(unsigned int, f->fmt.pix.height,
|
isp_sink_crop.height);
|
} else {
|
isp_sink_crop.width = f->fmt.pix.width;
|
isp_sink_crop.height = f->fmt.pix.height;
|
}
|
|
atomisp_subdev_set_selection(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK,
|
V4L2_SEL_TGT_CROP,
|
V4L2_SEL_FLAG_KEEP_CONFIG,
|
&isp_sink_crop);
|
atomisp_subdev_set_selection(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
source_pad, V4L2_SEL_TGT_COMPOSE,
|
0, &isp_sink_crop);
|
} else if (IS_MOFD) {
|
struct v4l2_rect main_compose = {0};
|
|
main_compose.width = isp_sink_crop.width;
|
main_compose.height =
|
DIV_ROUND_UP(main_compose.width * f->fmt.pix.height,
|
f->fmt.pix.width);
|
if (main_compose.height > isp_sink_crop.height) {
|
main_compose.height = isp_sink_crop.height;
|
main_compose.width =
|
DIV_ROUND_UP(main_compose.height *
|
f->fmt.pix.width,
|
f->fmt.pix.height);
|
}
|
|
atomisp_subdev_set_selection(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
source_pad,
|
V4L2_SEL_TGT_COMPOSE, 0,
|
&main_compose);
|
} else {
|
struct v4l2_rect sink_crop = {0};
|
struct v4l2_rect main_compose = {0};
|
|
main_compose.width = f->fmt.pix.width;
|
main_compose.height = f->fmt.pix.height;
|
|
/* WORKAROUND: this override is universally enabled in
|
* GMIN to work around a CTS failures (GMINL-539)
|
* which appears to be related by a hardware
|
* performance limitation. It's unclear why this
|
* particular code triggers the issue. */
|
if (!IS_ISP2401 || crop_needs_override) {
|
if (isp_sink_crop.width * main_compose.height >
|
isp_sink_crop.height * main_compose.width) {
|
sink_crop.height = isp_sink_crop.height;
|
sink_crop.width = DIV_NEAREST_STEP(
|
sink_crop.height *
|
f->fmt.pix.width,
|
f->fmt.pix.height,
|
ATOM_ISP_STEP_WIDTH);
|
} else {
|
sink_crop.width = isp_sink_crop.width;
|
sink_crop.height = DIV_NEAREST_STEP(
|
sink_crop.width *
|
f->fmt.pix.height,
|
f->fmt.pix.width,
|
ATOM_ISP_STEP_HEIGHT);
|
}
|
atomisp_subdev_set_selection(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK,
|
V4L2_SEL_TGT_CROP,
|
V4L2_SEL_FLAG_KEEP_CONFIG,
|
&sink_crop);
|
}
|
atomisp_subdev_set_selection(&asd->subdev, fh.pad,
|
V4L2_SUBDEV_FORMAT_ACTIVE,
|
source_pad,
|
V4L2_SEL_TGT_COMPOSE, 0,
|
&main_compose);
|
}
|
|
set_fmt_to_isp:
|
ret = atomisp_set_fmt_to_isp(vdev, &output_info, &raw_output_info,
|
&f->fmt.pix, source_pad);
|
if (ret) {
|
dev_warn(isp->dev, "Can't set format on ISP. Error %d\n", ret);
|
return -EINVAL;
|
}
|
done:
|
pipe->pix.width = f->fmt.pix.width;
|
pipe->pix.height = f->fmt.pix.height;
|
pipe->pix.pixelformat = f->fmt.pix.pixelformat;
|
if (format_bridge->planar) {
|
pipe->pix.bytesperline = output_info.padded_width;
|
pipe->pix.sizeimage = PAGE_ALIGN(f->fmt.pix.height *
|
DIV_ROUND_UP(format_bridge->depth *
|
output_info.padded_width, 8));
|
} else {
|
pipe->pix.bytesperline =
|
DIV_ROUND_UP(format_bridge->depth *
|
output_info.padded_width, 8);
|
pipe->pix.sizeimage =
|
PAGE_ALIGN(f->fmt.pix.height * pipe->pix.bytesperline);
|
}
|
dev_dbg(isp->dev, "%s: image size: %d, %d bytes per line\n",
|
__func__, pipe->pix.sizeimage, pipe->pix.bytesperline);
|
|
if (f->fmt.pix.field == V4L2_FIELD_ANY)
|
f->fmt.pix.field = V4L2_FIELD_NONE;
|
pipe->pix.field = f->fmt.pix.field;
|
|
f->fmt.pix = pipe->pix;
|
f->fmt.pix.priv = PAGE_ALIGN(pipe->pix.width *
|
pipe->pix.height * 2);
|
|
pipe->capq.field = f->fmt.pix.field;
|
|
/*
|
* If in video 480P case, no GFX throttle
|
*/
|
if (asd->run_mode->val == ATOMISP_SUBDEV_PAD_SOURCE_VIDEO &&
|
f->fmt.pix.width == 720 && f->fmt.pix.height == 480)
|
isp->need_gfx_throttle = false;
|
else
|
isp->need_gfx_throttle = true;
|
|
return 0;
|
}
|
|
int atomisp_set_fmt_file(struct video_device *vdev, struct v4l2_format *f)
|
{
|
struct atomisp_device *isp = video_get_drvdata(vdev);
|
struct atomisp_video_pipe *pipe = atomisp_to_video_pipe(vdev);
|
struct atomisp_sub_device *asd = pipe->asd;
|
struct v4l2_mbus_framefmt ffmt = {0};
|
const struct atomisp_format_bridge *format_bridge;
|
struct v4l2_subdev_fh fh;
|
int ret;
|
|
if (!asd) {
|
dev_err(isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, vdev->name);
|
return -EINVAL;
|
}
|
|
v4l2_fh_init(&fh.vfh, vdev);
|
|
dev_dbg(isp->dev, "setting fmt %ux%u 0x%x for file inject\n",
|
f->fmt.pix.width, f->fmt.pix.height, f->fmt.pix.pixelformat);
|
ret = atomisp_try_fmt_file(isp, f);
|
if (ret) {
|
dev_err(isp->dev, "atomisp_try_fmt_file err: %d\n", ret);
|
return ret;
|
}
|
|
format_bridge = atomisp_get_format_bridge(f->fmt.pix.pixelformat);
|
if (!format_bridge) {
|
dev_dbg(isp->dev, "atomisp_get_format_bridge err! fmt:0x%x\n",
|
f->fmt.pix.pixelformat);
|
return -EINVAL;
|
}
|
|
pipe->pix = f->fmt.pix;
|
atomisp_css_input_set_mode(asd, IA_CSS_INPUT_MODE_FIFO);
|
atomisp_css_input_configure_port(asd,
|
__get_mipi_port(isp, ATOMISP_CAMERA_PORT_PRIMARY), 2, 0xffff4,
|
0, 0, 0, 0);
|
ffmt.width = f->fmt.pix.width;
|
ffmt.height = f->fmt.pix.height;
|
ffmt.code = format_bridge->mbus_code;
|
|
atomisp_subdev_set_ffmt(&asd->subdev, fh.pad, V4L2_SUBDEV_FORMAT_ACTIVE,
|
ATOMISP_SUBDEV_PAD_SINK, &ffmt);
|
|
return 0;
|
}
|
|
int atomisp_set_shading_table(struct atomisp_sub_device *asd,
|
struct atomisp_shading_table *user_shading_table)
|
{
|
struct ia_css_shading_table *shading_table;
|
struct ia_css_shading_table *free_table;
|
unsigned int len_table;
|
int i;
|
int ret = 0;
|
|
if (!user_shading_table)
|
return -EINVAL;
|
|
if (!user_shading_table->enable) {
|
asd->params.config.shading_table = NULL;
|
asd->params.sc_en = false;
|
return 0;
|
}
|
|
/* If enabling, all tables must be set */
|
for (i = 0; i < ATOMISP_NUM_SC_COLORS; i++) {
|
if (!user_shading_table->data[i])
|
return -EINVAL;
|
}
|
|
/* Shading table size per color */
|
if (!IS_ISP2401) {
|
if (user_shading_table->width > ISP2400_SH_CSS_MAX_SCTBL_WIDTH_PER_COLOR ||
|
user_shading_table->height > ISP2400_SH_CSS_MAX_SCTBL_HEIGHT_PER_COLOR)
|
return -EINVAL;
|
} else {
|
if (user_shading_table->width > ISP2401_SH_CSS_MAX_SCTBL_WIDTH_PER_COLOR ||
|
user_shading_table->height > ISP2401_SH_CSS_MAX_SCTBL_HEIGHT_PER_COLOR)
|
return -EINVAL;
|
}
|
|
shading_table = atomisp_css_shading_table_alloc(
|
user_shading_table->width, user_shading_table->height);
|
if (!shading_table)
|
return -ENOMEM;
|
|
len_table = user_shading_table->width * user_shading_table->height *
|
ATOMISP_SC_TYPE_SIZE;
|
for (i = 0; i < ATOMISP_NUM_SC_COLORS; i++) {
|
ret = copy_from_user(shading_table->data[i],
|
(void __user *)user_shading_table->data[i],
|
len_table);
|
if (ret) {
|
free_table = shading_table;
|
ret = -EFAULT;
|
goto out;
|
}
|
}
|
shading_table->sensor_width = user_shading_table->sensor_width;
|
shading_table->sensor_height = user_shading_table->sensor_height;
|
shading_table->fraction_bits = user_shading_table->fraction_bits;
|
|
free_table = asd->params.css_param.shading_table;
|
asd->params.css_param.shading_table = shading_table;
|
asd->params.config.shading_table = shading_table;
|
asd->params.sc_en = true;
|
|
out:
|
if (free_table)
|
atomisp_css_shading_table_free(free_table);
|
|
return ret;
|
}
|
|
/*Turn off ISP dphy */
|
int atomisp_ospm_dphy_down(struct atomisp_device *isp)
|
{
|
struct pci_dev *pdev = to_pci_dev(isp->dev);
|
unsigned long flags;
|
u32 reg;
|
|
dev_dbg(isp->dev, "%s\n", __func__);
|
|
/* if ISP timeout, we can force powerdown */
|
if (isp->isp_timeout)
|
goto done;
|
|
if (!atomisp_dev_users(isp))
|
goto done;
|
|
spin_lock_irqsave(&isp->lock, flags);
|
isp->sw_contex.power_state = ATOM_ISP_POWER_DOWN;
|
spin_unlock_irqrestore(&isp->lock, flags);
|
done:
|
/*
|
* MRFLD IUNIT DPHY is located in an always-power-on island
|
* MRFLD HW design need all CSI ports are disabled before
|
* powering down the IUNIT.
|
*/
|
pci_read_config_dword(pdev, MRFLD_PCI_CSI_CONTROL, ®);
|
reg |= MRFLD_ALL_CSI_PORTS_OFF_MASK;
|
pci_write_config_dword(pdev, MRFLD_PCI_CSI_CONTROL, reg);
|
return 0;
|
}
|
|
/*Turn on ISP dphy */
|
int atomisp_ospm_dphy_up(struct atomisp_device *isp)
|
{
|
unsigned long flags;
|
|
dev_dbg(isp->dev, "%s\n", __func__);
|
|
spin_lock_irqsave(&isp->lock, flags);
|
isp->sw_contex.power_state = ATOM_ISP_POWER_UP;
|
spin_unlock_irqrestore(&isp->lock, flags);
|
|
return 0;
|
}
|
|
int atomisp_exif_makernote(struct atomisp_sub_device *asd,
|
struct atomisp_makernote_info *config)
|
{
|
struct v4l2_control ctrl;
|
struct atomisp_device *isp = asd->isp;
|
|
ctrl.id = V4L2_CID_FOCAL_ABSOLUTE;
|
if (v4l2_g_ctrl
|
(isp->inputs[asd->input_curr].camera->ctrl_handler, &ctrl)) {
|
dev_warn(isp->dev, "failed to g_ctrl for focal length\n");
|
return -EINVAL;
|
} else {
|
config->focal_length = ctrl.value;
|
}
|
|
ctrl.id = V4L2_CID_FNUMBER_ABSOLUTE;
|
if (v4l2_g_ctrl
|
(isp->inputs[asd->input_curr].camera->ctrl_handler, &ctrl)) {
|
dev_warn(isp->dev, "failed to g_ctrl for f-number\n");
|
return -EINVAL;
|
} else {
|
config->f_number_curr = ctrl.value;
|
}
|
|
ctrl.id = V4L2_CID_FNUMBER_RANGE;
|
if (v4l2_g_ctrl
|
(isp->inputs[asd->input_curr].camera->ctrl_handler, &ctrl)) {
|
dev_warn(isp->dev, "failed to g_ctrl for f number range\n");
|
return -EINVAL;
|
} else {
|
config->f_number_range = ctrl.value;
|
}
|
|
return 0;
|
}
|
|
int atomisp_offline_capture_configure(struct atomisp_sub_device *asd,
|
struct atomisp_cont_capture_conf *cvf_config)
|
{
|
struct v4l2_ctrl *c;
|
|
/*
|
* In case of M10MO ZSL capture case, we need to issue a separate
|
* capture request to M10MO which will output captured jpeg image
|
*/
|
c = v4l2_ctrl_find(
|
asd->isp->inputs[asd->input_curr].camera->ctrl_handler,
|
V4L2_CID_START_ZSL_CAPTURE);
|
if (c) {
|
int ret;
|
|
dev_dbg(asd->isp->dev, "%s trigger ZSL capture request\n",
|
__func__);
|
/* TODO: use the cvf_config */
|
ret = v4l2_ctrl_s_ctrl(c, 1);
|
if (ret)
|
return ret;
|
|
return v4l2_ctrl_s_ctrl(c, 0);
|
}
|
|
asd->params.offline_parm = *cvf_config;
|
|
if (asd->params.offline_parm.num_captures) {
|
if (asd->streaming == ATOMISP_DEVICE_STREAMING_DISABLED) {
|
unsigned int init_raw_num;
|
|
if (asd->enable_raw_buffer_lock->val) {
|
init_raw_num =
|
ATOMISP_CSS2_NUM_OFFLINE_INIT_CONTINUOUS_FRAMES_LOCK_EN;
|
if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO &&
|
asd->params.video_dis_en)
|
init_raw_num +=
|
ATOMISP_CSS2_NUM_DVS_FRAME_DELAY;
|
} else {
|
init_raw_num =
|
ATOMISP_CSS2_NUM_OFFLINE_INIT_CONTINUOUS_FRAMES;
|
}
|
|
/* TODO: this can be removed once user-space
|
* has been updated to use control API */
|
asd->continuous_raw_buffer_size->val =
|
max_t(int,
|
asd->continuous_raw_buffer_size->val,
|
asd->params.offline_parm.
|
num_captures + init_raw_num);
|
asd->continuous_raw_buffer_size->val =
|
min_t(int, ATOMISP_CONT_RAW_FRAMES,
|
asd->continuous_raw_buffer_size->val);
|
}
|
asd->continuous_mode->val = true;
|
} else {
|
asd->continuous_mode->val = false;
|
__enable_continuous_mode(asd, false);
|
}
|
|
return 0;
|
}
|
|
/*
|
* set auto exposure metering window to camera sensor
|
*/
|
int atomisp_s_ae_window(struct atomisp_sub_device *asd,
|
struct atomisp_ae_window *arg)
|
{
|
struct atomisp_device *isp = asd->isp;
|
/* Coverity CID 298071 - initialzize struct */
|
struct v4l2_subdev_selection sel = { 0 };
|
|
sel.r.left = arg->x_left;
|
sel.r.top = arg->y_top;
|
sel.r.width = arg->x_right - arg->x_left + 1;
|
sel.r.height = arg->y_bottom - arg->y_top + 1;
|
|
if (v4l2_subdev_call(isp->inputs[asd->input_curr].camera,
|
pad, set_selection, NULL, &sel)) {
|
dev_err(isp->dev, "failed to call sensor set_selection.\n");
|
return -EINVAL;
|
}
|
|
return 0;
|
}
|
|
int atomisp_flash_enable(struct atomisp_sub_device *asd, int num_frames)
|
{
|
struct atomisp_device *isp = asd->isp;
|
|
if (num_frames < 0) {
|
dev_dbg(isp->dev, "%s ERROR: num_frames: %d\n", __func__,
|
num_frames);
|
return -EINVAL;
|
}
|
/* a requested flash is still in progress. */
|
if (num_frames && asd->params.flash_state != ATOMISP_FLASH_IDLE) {
|
dev_dbg(isp->dev, "%s flash busy: %d frames left: %d\n",
|
__func__, asd->params.flash_state,
|
asd->params.num_flash_frames);
|
return -EBUSY;
|
}
|
|
asd->params.num_flash_frames = num_frames;
|
asd->params.flash_state = ATOMISP_FLASH_REQUESTED;
|
return 0;
|
}
|
|
int atomisp_source_pad_to_stream_id(struct atomisp_sub_device *asd,
|
uint16_t source_pad)
|
{
|
int stream_id;
|
struct atomisp_device *isp = asd->isp;
|
|
if (isp->inputs[asd->input_curr].camera_caps->
|
sensor[asd->sensor_curr].stream_num == 1)
|
return ATOMISP_INPUT_STREAM_GENERAL;
|
|
switch (source_pad) {
|
case ATOMISP_SUBDEV_PAD_SOURCE_CAPTURE:
|
stream_id = ATOMISP_INPUT_STREAM_CAPTURE;
|
break;
|
case ATOMISP_SUBDEV_PAD_SOURCE_VF:
|
stream_id = ATOMISP_INPUT_STREAM_POSTVIEW;
|
break;
|
case ATOMISP_SUBDEV_PAD_SOURCE_PREVIEW:
|
stream_id = ATOMISP_INPUT_STREAM_PREVIEW;
|
break;
|
case ATOMISP_SUBDEV_PAD_SOURCE_VIDEO:
|
stream_id = ATOMISP_INPUT_STREAM_VIDEO;
|
break;
|
default:
|
stream_id = ATOMISP_INPUT_STREAM_GENERAL;
|
}
|
|
return stream_id;
|
}
|
|
bool atomisp_is_vf_pipe(struct atomisp_video_pipe *pipe)
|
{
|
struct atomisp_sub_device *asd = pipe->asd;
|
|
if (!asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, pipe->vdev.name);
|
return false;
|
}
|
|
if (pipe == &asd->video_out_vf)
|
return true;
|
|
if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO &&
|
pipe == &asd->video_out_preview)
|
return true;
|
|
return false;
|
}
|
|
static int __checking_exp_id(struct atomisp_sub_device *asd, int exp_id)
|
{
|
struct atomisp_device *isp = asd->isp;
|
|
if (!asd->enable_raw_buffer_lock->val) {
|
dev_warn(isp->dev, "%s Raw Buffer Lock is disable.\n", __func__);
|
return -EINVAL;
|
}
|
if (asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED) {
|
dev_err(isp->dev, "%s streaming %d invalid exp_id %d.\n",
|
__func__, exp_id, asd->streaming);
|
return -EINVAL;
|
}
|
if ((exp_id > ATOMISP_MAX_EXP_ID) || (exp_id <= 0)) {
|
dev_err(isp->dev, "%s exp_id %d invalid.\n", __func__, exp_id);
|
return -EINVAL;
|
}
|
return 0;
|
}
|
|
void atomisp_init_raw_buffer_bitmap(struct atomisp_sub_device *asd)
|
{
|
unsigned long flags;
|
|
spin_lock_irqsave(&asd->raw_buffer_bitmap_lock, flags);
|
memset(asd->raw_buffer_bitmap, 0, sizeof(asd->raw_buffer_bitmap));
|
asd->raw_buffer_locked_count = 0;
|
spin_unlock_irqrestore(&asd->raw_buffer_bitmap_lock, flags);
|
}
|
|
int atomisp_set_raw_buffer_bitmap(struct atomisp_sub_device *asd, int exp_id)
|
{
|
int *bitmap, bit;
|
unsigned long flags;
|
|
if (__checking_exp_id(asd, exp_id))
|
return -EINVAL;
|
|
bitmap = asd->raw_buffer_bitmap + exp_id / 32;
|
bit = exp_id % 32;
|
spin_lock_irqsave(&asd->raw_buffer_bitmap_lock, flags);
|
(*bitmap) |= (1 << bit);
|
asd->raw_buffer_locked_count++;
|
spin_unlock_irqrestore(&asd->raw_buffer_bitmap_lock, flags);
|
|
dev_dbg(asd->isp->dev, "%s: exp_id %d, raw_buffer_locked_count %d\n",
|
__func__, exp_id, asd->raw_buffer_locked_count);
|
|
/* Check if the raw buffer after next is still locked!!! */
|
exp_id += 2;
|
if (exp_id > ATOMISP_MAX_EXP_ID)
|
exp_id -= ATOMISP_MAX_EXP_ID;
|
bitmap = asd->raw_buffer_bitmap + exp_id / 32;
|
bit = exp_id % 32;
|
if ((*bitmap) & (1 << bit)) {
|
int ret;
|
|
/* WORKAROUND unlock the raw buffer compulsively */
|
ret = atomisp_css_exp_id_unlock(asd, exp_id);
|
if (ret) {
|
dev_err(asd->isp->dev,
|
"%s exp_id is wrapping back to %d but force unlock failed,, err %d.\n",
|
__func__, exp_id, ret);
|
return ret;
|
}
|
|
spin_lock_irqsave(&asd->raw_buffer_bitmap_lock, flags);
|
(*bitmap) &= ~(1 << bit);
|
asd->raw_buffer_locked_count--;
|
spin_unlock_irqrestore(&asd->raw_buffer_bitmap_lock, flags);
|
dev_warn(asd->isp->dev,
|
"%s exp_id is wrapping back to %d but it is still locked so force unlock it, raw_buffer_locked_count %d\n",
|
__func__, exp_id, asd->raw_buffer_locked_count);
|
}
|
return 0;
|
}
|
|
static int __is_raw_buffer_locked(struct atomisp_sub_device *asd, int exp_id)
|
{
|
int *bitmap, bit;
|
unsigned long flags;
|
int ret;
|
|
if (__checking_exp_id(asd, exp_id))
|
return -EINVAL;
|
|
bitmap = asd->raw_buffer_bitmap + exp_id / 32;
|
bit = exp_id % 32;
|
spin_lock_irqsave(&asd->raw_buffer_bitmap_lock, flags);
|
ret = ((*bitmap) & (1 << bit));
|
spin_unlock_irqrestore(&asd->raw_buffer_bitmap_lock, flags);
|
return !ret;
|
}
|
|
static int __clear_raw_buffer_bitmap(struct atomisp_sub_device *asd, int exp_id)
|
{
|
int *bitmap, bit;
|
unsigned long flags;
|
|
if (__is_raw_buffer_locked(asd, exp_id))
|
return -EINVAL;
|
|
bitmap = asd->raw_buffer_bitmap + exp_id / 32;
|
bit = exp_id % 32;
|
spin_lock_irqsave(&asd->raw_buffer_bitmap_lock, flags);
|
(*bitmap) &= ~(1 << bit);
|
asd->raw_buffer_locked_count--;
|
spin_unlock_irqrestore(&asd->raw_buffer_bitmap_lock, flags);
|
|
dev_dbg(asd->isp->dev, "%s: exp_id %d, raw_buffer_locked_count %d\n",
|
__func__, exp_id, asd->raw_buffer_locked_count);
|
return 0;
|
}
|
|
int atomisp_exp_id_capture(struct atomisp_sub_device *asd, int *exp_id)
|
{
|
struct atomisp_device *isp = asd->isp;
|
int value = *exp_id;
|
int ret;
|
|
ret = __is_raw_buffer_locked(asd, value);
|
if (ret) {
|
dev_err(isp->dev, "%s exp_id %d invalid %d.\n", __func__, value, ret);
|
return -EINVAL;
|
}
|
|
dev_dbg(isp->dev, "%s exp_id %d\n", __func__, value);
|
ret = atomisp_css_exp_id_capture(asd, value);
|
if (ret) {
|
dev_err(isp->dev, "%s exp_id %d failed.\n", __func__, value);
|
return -EIO;
|
}
|
return 0;
|
}
|
|
int atomisp_exp_id_unlock(struct atomisp_sub_device *asd, int *exp_id)
|
{
|
struct atomisp_device *isp = asd->isp;
|
int value = *exp_id;
|
int ret;
|
|
ret = __clear_raw_buffer_bitmap(asd, value);
|
if (ret) {
|
dev_err(isp->dev, "%s exp_id %d invalid %d.\n", __func__, value, ret);
|
return -EINVAL;
|
}
|
|
dev_dbg(isp->dev, "%s exp_id %d\n", __func__, value);
|
ret = atomisp_css_exp_id_unlock(asd, value);
|
if (ret)
|
dev_err(isp->dev, "%s exp_id %d failed, err %d.\n",
|
__func__, value, ret);
|
|
return ret;
|
}
|
|
int atomisp_enable_dz_capt_pipe(struct atomisp_sub_device *asd,
|
unsigned int *enable)
|
{
|
bool value;
|
|
if (!enable)
|
return -EINVAL;
|
|
value = *enable > 0;
|
|
atomisp_en_dz_capt_pipe(asd, value);
|
|
return 0;
|
}
|
|
int atomisp_inject_a_fake_event(struct atomisp_sub_device *asd, int *event)
|
{
|
if (!event || asd->streaming != ATOMISP_DEVICE_STREAMING_ENABLED)
|
return -EINVAL;
|
|
dev_dbg(asd->isp->dev, "%s: trying to inject a fake event 0x%x\n",
|
__func__, *event);
|
|
switch (*event) {
|
case V4L2_EVENT_FRAME_SYNC:
|
atomisp_sof_event(asd);
|
break;
|
case V4L2_EVENT_FRAME_END:
|
atomisp_eof_event(asd, 0);
|
break;
|
case V4L2_EVENT_ATOMISP_3A_STATS_READY:
|
atomisp_3a_stats_ready_event(asd, 0);
|
break;
|
case V4L2_EVENT_ATOMISP_METADATA_READY:
|
atomisp_metadata_ready_event(asd, 0);
|
break;
|
default:
|
return -EINVAL;
|
}
|
|
return 0;
|
}
|
|
static int atomisp_get_pipe_id(struct atomisp_video_pipe *pipe)
|
{
|
struct atomisp_sub_device *asd = pipe->asd;
|
|
if (!asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, pipe->vdev.name);
|
return -EINVAL;
|
}
|
|
if (ATOMISP_USE_YUVPP(asd)) {
|
return IA_CSS_PIPE_ID_YUVPP;
|
} else if (asd->vfpp->val == ATOMISP_VFPP_DISABLE_SCALER) {
|
return IA_CSS_PIPE_ID_VIDEO;
|
} else if (asd->vfpp->val == ATOMISP_VFPP_DISABLE_LOWLAT) {
|
return IA_CSS_PIPE_ID_CAPTURE;
|
} else if (pipe == &asd->video_out_video_capture) {
|
return IA_CSS_PIPE_ID_VIDEO;
|
} else if (pipe == &asd->video_out_vf) {
|
return IA_CSS_PIPE_ID_CAPTURE;
|
} else if (pipe == &asd->video_out_preview) {
|
if (asd->run_mode->val == ATOMISP_RUN_MODE_VIDEO)
|
return IA_CSS_PIPE_ID_VIDEO;
|
else
|
return IA_CSS_PIPE_ID_PREVIEW;
|
} else if (pipe == &asd->video_out_capture) {
|
if (asd->copy_mode)
|
return IA_CSS_PIPE_ID_COPY;
|
else
|
return IA_CSS_PIPE_ID_CAPTURE;
|
}
|
|
/* fail through */
|
dev_warn(asd->isp->dev, "%s failed to find proper pipe\n",
|
__func__);
|
return IA_CSS_PIPE_ID_CAPTURE;
|
}
|
|
int atomisp_get_invalid_frame_num(struct video_device *vdev,
|
int *invalid_frame_num)
|
{
|
struct atomisp_video_pipe *pipe = atomisp_to_video_pipe(vdev);
|
struct atomisp_sub_device *asd = pipe->asd;
|
enum ia_css_pipe_id pipe_id;
|
struct ia_css_pipe_info p_info;
|
int ret;
|
|
if (!asd) {
|
dev_err(pipe->isp->dev, "%s(): asd is NULL, device is %s\n",
|
__func__, vdev->name);
|
return -EINVAL;
|
}
|
|
if (asd->isp->inputs[asd->input_curr].camera_caps->
|
sensor[asd->sensor_curr].stream_num > 1) {
|
/* External ISP */
|
*invalid_frame_num = 0;
|
return 0;
|
}
|
|
pipe_id = atomisp_get_pipe_id(pipe);
|
if (!asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL].pipes[pipe_id]) {
|
dev_warn(asd->isp->dev,
|
"%s pipe %d has not been created yet, do SET_FMT first!\n",
|
__func__, pipe_id);
|
return -EINVAL;
|
}
|
|
ret = ia_css_pipe_get_info(
|
asd->stream_env[ATOMISP_INPUT_STREAM_GENERAL]
|
.pipes[pipe_id], &p_info);
|
if (!ret) {
|
*invalid_frame_num = p_info.num_invalid_frames;
|
return 0;
|
} else {
|
dev_warn(asd->isp->dev, "%s get pipe infor failed %d\n",
|
__func__, ret);
|
return -EINVAL;
|
}
|
}
|
