mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-15 15:15:47 +00:00
media: staging: atomisp: Move to upstream IOSF MBI API
There is a common for x86 IOSF MBI API. Move atomisp code to use it. Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Mauro Carvalho Chehab <mchehab@s-opensource.com>
This commit is contained in:
parent
e64d5bd481
commit
66228be9ff
3 changed files with 29 additions and 30 deletions
|
@ -5,6 +5,7 @@
|
||||||
config VIDEO_ATOMISP
|
config VIDEO_ATOMISP
|
||||||
tristate "Intel Atom Image Signal Processor Driver"
|
tristate "Intel Atom Image Signal Processor Driver"
|
||||||
depends on VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API
|
depends on VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API
|
||||||
|
select IOSF_MBI
|
||||||
select VIDEOBUF_VMALLOC
|
select VIDEOBUF_VMALLOC
|
||||||
---help---
|
---help---
|
||||||
Say Y here if your platform supports Intel Atom SoC
|
Say Y here if your platform supports Intel Atom SoC
|
||||||
|
|
|
@ -27,7 +27,9 @@
|
||||||
#include <linux/kfifo.h>
|
#include <linux/kfifo.h>
|
||||||
#include <linux/pm_runtime.h>
|
#include <linux/pm_runtime.h>
|
||||||
#include <linux/timer.h>
|
#include <linux/timer.h>
|
||||||
|
|
||||||
#include <asm/intel-mid.h>
|
#include <asm/intel-mid.h>
|
||||||
|
#include <asm/iosf_mbi.h>
|
||||||
|
|
||||||
#include <media/v4l2-event.h>
|
#include <media/v4l2-event.h>
|
||||||
#include <media/videobuf-vmalloc.h>
|
#include <media/videobuf-vmalloc.h>
|
||||||
|
@ -143,36 +145,36 @@ static int write_target_freq_to_hw(struct atomisp_device *isp,
|
||||||
unsigned int ratio, timeout, guar_ratio;
|
unsigned int ratio, timeout, guar_ratio;
|
||||||
u32 isp_sspm1 = 0;
|
u32 isp_sspm1 = 0;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
if (!isp->hpll_freq) {
|
if (!isp->hpll_freq) {
|
||||||
dev_err(isp->dev, "failed to get hpll_freq. no change to freq\n");
|
dev_err(isp->dev, "failed to get hpll_freq. no change to freq\n");
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
isp_sspm1 = intel_mid_msgbus_read32(PUNIT_PORT, ISPSSPM1);
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
||||||
if (isp_sspm1 & ISP_FREQ_VALID_MASK) {
|
if (isp_sspm1 & ISP_FREQ_VALID_MASK) {
|
||||||
dev_dbg(isp->dev, "clearing ISPSSPM1 valid bit.\n");
|
dev_dbg(isp->dev, "clearing ISPSSPM1 valid bit.\n");
|
||||||
intel_mid_msgbus_write32(PUNIT_PORT, ISPSSPM1,
|
iosf_mbi_write(BT_MBI_UNIT_PMC, MBI_REG_WRITE, ISPSSPM1,
|
||||||
isp_sspm1 & ~(1 << ISP_FREQ_VALID_OFFSET));
|
isp_sspm1 & ~(1 << ISP_FREQ_VALID_OFFSET));
|
||||||
}
|
}
|
||||||
|
|
||||||
ratio = (2 * isp->hpll_freq + new_freq / 2) / new_freq - 1;
|
ratio = (2 * isp->hpll_freq + new_freq / 2) / new_freq - 1;
|
||||||
guar_ratio = (2 * isp->hpll_freq + 200 / 2) / 200 - 1;
|
guar_ratio = (2 * isp->hpll_freq + 200 / 2) / 200 - 1;
|
||||||
|
|
||||||
isp_sspm1 = intel_mid_msgbus_read32(PUNIT_PORT, ISPSSPM1);
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
||||||
isp_sspm1 &= ~(0x1F << ISP_REQ_FREQ_OFFSET);
|
isp_sspm1 &= ~(0x1F << ISP_REQ_FREQ_OFFSET);
|
||||||
|
|
||||||
for (i = 0; i < ISP_DFS_TRY_TIMES; i++) {
|
for (i = 0; i < ISP_DFS_TRY_TIMES; i++) {
|
||||||
intel_mid_msgbus_write32(PUNIT_PORT, ISPSSPM1,
|
iosf_mbi_write(BT_MBI_UNIT_PMC, MBI_REG_WRITE, ISPSSPM1,
|
||||||
isp_sspm1
|
isp_sspm1
|
||||||
| ratio << ISP_REQ_FREQ_OFFSET
|
| ratio << ISP_REQ_FREQ_OFFSET
|
||||||
| 1 << ISP_FREQ_VALID_OFFSET
|
| 1 << ISP_FREQ_VALID_OFFSET
|
||||||
| guar_ratio << ISP_REQ_GUAR_FREQ_OFFSET);
|
| guar_ratio << ISP_REQ_GUAR_FREQ_OFFSET);
|
||||||
|
|
||||||
isp_sspm1 = intel_mid_msgbus_read32(PUNIT_PORT, ISPSSPM1);
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
||||||
|
|
||||||
timeout = 20;
|
timeout = 20;
|
||||||
while ((isp_sspm1 & ISP_FREQ_VALID_MASK) && timeout) {
|
while ((isp_sspm1 & ISP_FREQ_VALID_MASK) && timeout) {
|
||||||
isp_sspm1 = intel_mid_msgbus_read32(PUNIT_PORT, ISPSSPM1);
|
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");
|
dev_dbg(isp->dev, "waiting for ISPSSPM1 valid bit to be 0.\n");
|
||||||
udelay(100);
|
udelay(100);
|
||||||
timeout--;
|
timeout--;
|
||||||
|
@ -187,10 +189,10 @@ static int write_target_freq_to_hw(struct atomisp_device *isp,
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
isp_sspm1 = intel_mid_msgbus_read32(PUNIT_PORT, ISPSSPM1);
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, ISPSSPM1, &isp_sspm1);
|
||||||
timeout = 10;
|
timeout = 10;
|
||||||
while (((isp_sspm1 >> ISP_FREQ_STAT_OFFSET) != ratio) && timeout) {
|
while (((isp_sspm1 >> ISP_FREQ_STAT_OFFSET) != ratio) && timeout) {
|
||||||
isp_sspm1 = intel_mid_msgbus_read32(PUNIT_PORT, ISPSSPM1);
|
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",
|
dev_dbg(isp->dev, "waiting for ISPSSPM1 status bit to be 0x%x.\n",
|
||||||
new_freq);
|
new_freq);
|
||||||
udelay(100);
|
udelay(100);
|
||||||
|
|
|
@ -28,6 +28,9 @@
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
|
|
||||||
|
#include <asm/intel-mid.h>
|
||||||
|
#include <asm/iosf_mbi.h>
|
||||||
|
|
||||||
#include "../../include/linux/atomisp_gmin_platform.h"
|
#include "../../include/linux/atomisp_gmin_platform.h"
|
||||||
|
|
||||||
#include "atomisp_cmd.h"
|
#include "atomisp_cmd.h"
|
||||||
|
@ -46,7 +49,6 @@
|
||||||
#include "hrt/hive_isp_css_mm_hrt.h"
|
#include "hrt/hive_isp_css_mm_hrt.h"
|
||||||
|
|
||||||
#include "device_access.h"
|
#include "device_access.h"
|
||||||
#include <asm/intel-mid.h>
|
|
||||||
|
|
||||||
/* G-Min addition: pull this in from intel_mid_pm.h */
|
/* G-Min addition: pull this in from intel_mid_pm.h */
|
||||||
#define CSTATE_EXIT_LATENCY_C1 1
|
#define CSTATE_EXIT_LATENCY_C1 1
|
||||||
|
@ -386,28 +388,23 @@ static int atomisp_mrfld_pre_power_down(struct atomisp_device *isp)
|
||||||
*/
|
*/
|
||||||
static void punit_ddr_dvfs_enable(bool enable)
|
static void punit_ddr_dvfs_enable(bool enable)
|
||||||
{
|
{
|
||||||
int reg = intel_mid_msgbus_read32(PUNIT_PORT, MRFLD_ISPSSDVFS);
|
|
||||||
int door_bell = 1 << 8;
|
int door_bell = 1 << 8;
|
||||||
int max_wait = 30;
|
int max_wait = 30;
|
||||||
|
int reg;
|
||||||
|
|
||||||
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, MRFLD_ISPSSDVFS, ®);
|
||||||
if (enable) {
|
if (enable) {
|
||||||
reg &= ~(MRFLD_BIT0 | MRFLD_BIT1);
|
reg &= ~(MRFLD_BIT0 | MRFLD_BIT1);
|
||||||
} else {
|
} else {
|
||||||
reg |= (MRFLD_BIT1 | door_bell);
|
reg |= (MRFLD_BIT1 | door_bell);
|
||||||
reg &= ~(MRFLD_BIT0);
|
reg &= ~(MRFLD_BIT0);
|
||||||
}
|
}
|
||||||
|
iosf_mbi_write(BT_MBI_UNIT_PMC, MBI_REG_WRITE, MRFLD_ISPSSDVFS, reg);
|
||||||
|
|
||||||
intel_mid_msgbus_write32(PUNIT_PORT, MRFLD_ISPSSDVFS, reg);
|
/* Check Req_ACK to see freq status, wait until door_bell is cleared */
|
||||||
|
while ((reg & door_bell) && max_wait--) {
|
||||||
/*Check Req_ACK to see freq status, wait until door_bell is cleared*/
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, MRFLD_ISPSSDVFS, ®);
|
||||||
if (reg & door_bell) {
|
usleep_range(100, 500);
|
||||||
while (max_wait--) {
|
|
||||||
if (0 == (intel_mid_msgbus_read32(PUNIT_PORT,
|
|
||||||
MRFLD_ISPSSDVFS) & door_bell))
|
|
||||||
break;
|
|
||||||
|
|
||||||
usleep_range(100, 500);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if (max_wait == -1)
|
if (max_wait == -1)
|
||||||
|
@ -421,10 +418,10 @@ int atomisp_mrfld_power_down(struct atomisp_device *isp)
|
||||||
u32 reg_value;
|
u32 reg_value;
|
||||||
|
|
||||||
/* writing 0x3 to ISPSSPM0 bit[1:0] to power off the IUNIT */
|
/* writing 0x3 to ISPSSPM0 bit[1:0] to power off the IUNIT */
|
||||||
reg_value = intel_mid_msgbus_read32(PUNIT_PORT, MRFLD_ISPSSPM0);
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, MRFLD_ISPSSPM0, ®_value);
|
||||||
reg_value &= ~MRFLD_ISPSSPM0_ISPSSC_MASK;
|
reg_value &= ~MRFLD_ISPSSPM0_ISPSSC_MASK;
|
||||||
reg_value |= MRFLD_ISPSSPM0_IUNIT_POWER_OFF;
|
reg_value |= MRFLD_ISPSSPM0_IUNIT_POWER_OFF;
|
||||||
intel_mid_msgbus_write32(PUNIT_PORT, MRFLD_ISPSSPM0, reg_value);
|
iosf_mbi_write(BT_MBI_UNIT_PMC, MBI_REG_WRITE, MRFLD_ISPSSPM0, reg_value);
|
||||||
|
|
||||||
/*WA:Enable DVFS*/
|
/*WA:Enable DVFS*/
|
||||||
if (IS_CHT)
|
if (IS_CHT)
|
||||||
|
@ -437,8 +434,7 @@ int atomisp_mrfld_power_down(struct atomisp_device *isp)
|
||||||
*/
|
*/
|
||||||
timeout = jiffies + msecs_to_jiffies(50);
|
timeout = jiffies + msecs_to_jiffies(50);
|
||||||
while (1) {
|
while (1) {
|
||||||
reg_value = intel_mid_msgbus_read32(PUNIT_PORT,
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, MRFLD_ISPSSPM0, ®_value);
|
||||||
MRFLD_ISPSSPM0);
|
|
||||||
dev_dbg(isp->dev, "power-off in progress, ISPSSPM0: 0x%x\n",
|
dev_dbg(isp->dev, "power-off in progress, ISPSSPM0: 0x%x\n",
|
||||||
reg_value);
|
reg_value);
|
||||||
/* wait until ISPSSPM0 bit[25:24] shows 0x3 */
|
/* wait until ISPSSPM0 bit[25:24] shows 0x3 */
|
||||||
|
@ -477,14 +473,14 @@ int atomisp_mrfld_power_up(struct atomisp_device *isp)
|
||||||
msleep(10);
|
msleep(10);
|
||||||
|
|
||||||
/* writing 0x0 to ISPSSPM0 bit[1:0] to power off the IUNIT */
|
/* writing 0x0 to ISPSSPM0 bit[1:0] to power off the IUNIT */
|
||||||
reg_value = intel_mid_msgbus_read32(PUNIT_PORT, MRFLD_ISPSSPM0);
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, MRFLD_ISPSSPM0, ®_value);
|
||||||
reg_value &= ~MRFLD_ISPSSPM0_ISPSSC_MASK;
|
reg_value &= ~MRFLD_ISPSSPM0_ISPSSC_MASK;
|
||||||
intel_mid_msgbus_write32(PUNIT_PORT, MRFLD_ISPSSPM0, reg_value);
|
iosf_mbi_write(BT_MBI_UNIT_PMC, MBI_REG_WRITE, MRFLD_ISPSSPM0, reg_value);
|
||||||
|
|
||||||
/* FIXME: experienced value for delay */
|
/* FIXME: experienced value for delay */
|
||||||
timeout = jiffies + msecs_to_jiffies(50);
|
timeout = jiffies + msecs_to_jiffies(50);
|
||||||
while (1) {
|
while (1) {
|
||||||
reg_value = intel_mid_msgbus_read32(PUNIT_PORT, MRFLD_ISPSSPM0);
|
iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ, MRFLD_ISPSSPM0, ®_value);
|
||||||
dev_dbg(isp->dev, "power-on in progress, ISPSSPM0: 0x%x\n",
|
dev_dbg(isp->dev, "power-on in progress, ISPSSPM0: 0x%x\n",
|
||||||
reg_value);
|
reg_value);
|
||||||
/* wait until ISPSSPM0 bit[25:24] shows 0x0 */
|
/* wait until ISPSSPM0 bit[25:24] shows 0x0 */
|
||||||
|
@ -1323,7 +1319,7 @@ static int atomisp_pci_probe(struct pci_dev *dev,
|
||||||
isp->dfs = &dfs_config_cht;
|
isp->dfs = &dfs_config_cht;
|
||||||
isp->pdev->d3cold_delay = 0;
|
isp->pdev->d3cold_delay = 0;
|
||||||
|
|
||||||
val = intel_mid_msgbus_read32(CCK_PORT, CCK_FUSE_REG_0);
|
iosf_mbi_read(CCK_PORT, MBI_REG_READ, CCK_FUSE_REG_0, &val);
|
||||||
switch (val & CCK_FUSE_HPLL_FREQ_MASK) {
|
switch (val & CCK_FUSE_HPLL_FREQ_MASK) {
|
||||||
case 0x00:
|
case 0x00:
|
||||||
isp->hpll_freq = HPLL_FREQ_800MHZ;
|
isp->hpll_freq = HPLL_FREQ_800MHZ;
|
||||||
|
|
Loading…
Reference in a new issue