summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
Diffstat
-rw-r--r--arch/arm/mach-tegra/board-enterprise-sensors.c180
-rw-r--r--arch/arm/mach-tegra/board-enterprise.h6
2 files changed, 177 insertions, 9 deletions
diff --git a/arch/arm/mach-tegra/board-enterprise-sensors.c b/arch/arm/mach-tegra/board-enterprise-sensors.c
index bc6c146c03c0..cb100534987b 100644
--- a/arch/arm/mach-tegra/board-enterprise-sensors.c
+++ b/arch/arm/mach-tegra/board-enterprise-sensors.c
@@ -28,6 +28,7 @@
#include <mach/gpio.h>
#include <media/ar0832_main.h>
+#include <media/ov9726.h>
#include "cpu-tegra.h"
#include "gpio-names.h"
#include "board-enterprise.h"
@@ -153,14 +154,106 @@ static void enterprise_isl_init(void)
ARRAY_SIZE(enterprise_i2c0_isl_board_info));
}
+typedef enum {
+ CAM_REAR_LEFT,
+ CAM_REAR_RIGHT,
+ CAM_FRONT,
+ NUM_OF_CAM
+} CAMERA_INDEX;
+
+struct ent_camera_regulators {
+ struct regulator *cam_reg;
+ struct regulator *csi_reg;
+ bool cam_pwr_state[NUM_OF_CAM];
+};
-static struct regulator *cam_reg;
-static struct regulator *csi_reg;
+static struct ent_camera_regulators ent_cam_pwr;
-static int enterprise_ar0832_power_on(void)
+static int enterprise_cam_pwr(CAMERA_INDEX cam, bool pwr_on)
{
int ret = 0;
+ bool *pwr_ptr = ent_cam_pwr.cam_pwr_state;
+
+ /*
+ * SW must turn on 1.8V first then 2.8V
+ * SW must turn off 2.8V first then 1.8V
+ */
+ if (pwr_on) {
+ if (!pwr_ptr[CAM_REAR_LEFT] &&
+ !pwr_ptr[CAM_REAR_RIGHT] &&
+ !pwr_ptr[CAM_REAR_RIGHT]) {
+ if (ent_cam_pwr.csi_reg == NULL) {
+ ent_cam_pwr.csi_reg = regulator_get(NULL, "avdd_dsi_csi");
+ if (IS_ERR_OR_NULL(ent_cam_pwr.csi_reg)) {
+ pr_err("%s: get csi pwr err\n", __func__);
+ ret = PTR_ERR(ent_cam_pwr.csi_reg);
+ goto enterprise_cam_pwr_fail;
+ }
+ }
+
+ ret = regulator_enable(ent_cam_pwr.csi_reg);
+ if (ret) {
+ pr_err("%s: enable csi pwr err\n", __func__);
+ goto enterprise_cam_pwr_fail;
+ }
+
+ if (ent_cam_pwr.cam_reg == NULL) {
+ ent_cam_pwr.cam_reg = regulator_get(NULL, "vddio_cam");
+ if (IS_ERR_OR_NULL(ent_cam_pwr.cam_reg)) {
+ pr_err("%s: get cam pwr err\n", __func__);
+ ret = PTR_ERR(ent_cam_pwr.cam_reg);
+ goto enterprise_cam_pwr_fail;
+ }
+ }
+
+ ret = regulator_enable(ent_cam_pwr.cam_reg);
+ if (ret) {
+ pr_err("%s: enable cam pwr err\n", __func__);
+ goto enterprise_cam_pwr_fail;
+ }
+ }
+
+ // turn on powers
+ gpio_set_value(CAM_LDO_1V8_EN_L_GPIO, 1);
+ enterprise_msleep(20);
+ gpio_set_value(CAM_LDO_2V8_EN_L_GPIO, 1);
+ pwr_ptr[cam] = true;
+ }
+ else {
+ pwr_ptr[cam] = false;
+ if (!pwr_ptr[CAM_REAR_LEFT] &&
+ !pwr_ptr[CAM_REAR_RIGHT] &&
+ !pwr_ptr[CAM_REAR_RIGHT]) {
+ if (ent_cam_pwr.cam_reg)
+ regulator_disable(ent_cam_pwr.cam_reg);
+
+ if (ent_cam_pwr.csi_reg)
+ regulator_disable(ent_cam_pwr.csi_reg);
+
+ // turn powers off
+ gpio_set_value(CAM_LDO_2V8_EN_L_GPIO, 0);
+ enterprise_msleep(20);
+ gpio_set_value(CAM_LDO_1V8_EN_L_GPIO, 0);
+ }
+ }
+ return 0;
+
+enterprise_cam_pwr_fail:
+ if (!IS_ERR_OR_NULL(ent_cam_pwr.cam_reg))
+ regulator_put(ent_cam_pwr.cam_reg);
+ ent_cam_pwr.cam_reg = NULL;
+
+ if (!IS_ERR_OR_NULL(ent_cam_pwr.csi_reg))
+ regulator_put(ent_cam_pwr.csi_reg);
+ ent_cam_pwr.csi_reg = NULL;
+ return ret;
+}
+
+static int enterprise_ar0832_power_on(void)
+{
+ int ret = 0;
+#if 0
csi_reg = regulator_get(NULL, "avdd_dsi_csi");
if (IS_ERR_OR_NULL(csi_reg)) {
pr_err("%s: get csi pwr err\n", __func__);
@@ -190,10 +283,19 @@ static int enterprise_ar0832_power_on(void)
enterprise_msleep(20);
pr_info("%s: enable 2.8V...\n", __func__);
gpio_set_value(CAM_LDO_2V8_EN_L_GPIO, 1);
+#else
+ ret = enterprise_cam_pwr(CAM_REAR_RIGHT, true);
+ if (ret)
+ return ret;
+#endif
gpio_set_value(CAM1_PWDN_GPIO, 1);
enterprise_msleep(5);
gpio_set_value(CAM1_RST_L_GPIO, 1);
+
+ // switch mipi mux to rear camera
+ gpio_set_value(CAM_CSI_MUX_SEL_GPIO, CAM_CSI_MUX_SEL_REAR);
+
/*
It takes 2400 EXTCLK for ar0832 to be ready for I2c.
EXTCLK is 10 ~ 24MCK. 1 ms should be enough to cover
@@ -201,17 +303,19 @@ static int enterprise_ar0832_power_on(void)
*/
enterprise_msleep(1);
return 0;
-
+#if 0
fail_regulator_cam_reg:
regulator_put(cam_reg);
fail_regulator_csi_reg:
regulator_put(csi_reg);
return ret;
+#endif
}
static int enterprise_ar0832_power_off(void)
{
+#if 0
if (cam_reg) {
regulator_disable(cam_reg);
regulator_put(cam_reg);
@@ -224,6 +328,9 @@ static int enterprise_ar0832_power_off(void)
gpio_set_value(CAM_LDO_2V8_EN_L_GPIO, 0);
mdelay(20);
gpio_set_value(CAM_LDO_1V8_EN_L_GPIO, 0);
+#else
+ enterprise_cam_pwr(CAM_REAR_RIGHT, true);
+#endif
return 0;
}
@@ -261,7 +368,55 @@ struct ar0832_platform_data enterprise_ar0832_data = {
.power_off = enterprise_ar0832_power_off,
};
-static struct i2c_board_info ar0832_i2c2_boardinfo[] = {
+static int enterprise_ov9726_power_on(void)
+{
+ pr_info("ov9726 power on\n");
+
+ enterprise_cam_pwr(CAM_FRONT, true);
+ enterprise_msleep(1);
+ gpio_set_value(CAM3_PWDN_GPIO, CAM3_PWDN_FALSE); // turn on ov9726
+
+ enterprise_msleep(5);
+
+ gpio_set_value(CAM3_RST_L_GPIO, CAM3_RST_L_TRUE);
+ enterprise_msleep(5);
+ gpio_set_value(CAM3_RST_L_GPIO, CAM3_RST_L_FALSE);
+ enterprise_msleep(20);
+
+ // switch mipi mux to front camera
+ gpio_set_value(CAM_CSI_MUX_SEL_GPIO, CAM_CSI_MUX_SEL_FRONT);
+
+ pr_info("cs0n: %x %x %x\n",
+ gpio_get_value(CAM3_PWDN_GPIO),
+ gpio_get_value(CAM_LDO_1V8_EN_L_GPIO),
+ gpio_get_value(CAM_CSI_MUX_SEL_GPIO));
+
+ return 0;
+}
+
+static int enterprise_ov9726_power_off(void)
+{
+ pr_info("ov9726 power off\n");
+
+ gpio_set_value(CAM3_RST_L_GPIO, CAM3_RST_L_TRUE); // pull low the RST pin of ov9726
+ enterprise_msleep(1);
+ gpio_set_value(CAM3_PWDN_GPIO, CAM3_PWDN_TRUE); // turn off ov9726
+ enterprise_msleep(1);
+ enterprise_cam_pwr(CAM_FRONT, false);
+ pr_info("cs0n: %x %x %x\n",
+ gpio_get_value(CAM3_PWDN_GPIO),
+ gpio_get_value(CAM_LDO_1V8_EN_L_GPIO),
+ gpio_get_value(CAM_CSI_MUX_SEL_GPIO));
+
+ return 0;
+}
+
+struct ov9726_platform_data enterprise_ov9726_data = {
+ .power_on = enterprise_ov9726_power_on,
+ .power_off = enterprise_ov9726_power_off,
+};
+
+static struct i2c_board_info enterprise_i2c2_board_info[] = {
{
I2C_BOARD_INFO("ar0832", 0x36),
.platform_data = &enterprise_ar0832_data,
@@ -269,6 +424,10 @@ static struct i2c_board_info ar0832_i2c2_boardinfo[] = {
{
I2C_BOARD_INFO("ar0832_focuser", 0x36),
},
+ {
+ I2C_BOARD_INFO("ov9726", OV9726_I2C_ADDR >> 1 ),
+ .platform_data = &enterprise_ov9726_data,
+ },
};
static int enterprise_cam_init(void)
@@ -278,6 +437,8 @@ static int enterprise_cam_init(void)
pr_info("%s:++\n", __func__);
+ memset(&ent_cam_pwr, sizeof(struct ent_camera_regulators), 0);
+
for (i = 0; i < ARRAY_SIZE(enterprise_cam_gpio_data); i++) {
ret = gpio_request(enterprise_cam_gpio_data[i].gpio,
enterprise_cam_gpio_data[i].label);
@@ -292,8 +453,8 @@ static int enterprise_cam_init(void)
tegra_gpio_enable(enterprise_cam_gpio_data[i].gpio);
}
- i2c_register_board_info(2, ar0832_i2c2_boardinfo,
- ARRAY_SIZE(ar0832_i2c2_boardinfo));
+ i2c_register_board_info(2, enterprise_i2c2_board_info,
+ ARRAY_SIZE(enterprise_i2c2_board_info));
return 0;
@@ -306,10 +467,11 @@ fail_free_gpio:
int __init enterprise_sensors_init(void)
{
+ int ret;
enterprise_isl_init();
enterprise_nct1008_init();
enterprise_mpuirq_init();
- enterprise_cam_init();
+ ret = enterprise_cam_init();
- return 0;
+ return ret;
}
diff --git a/arch/arm/mach-tegra/board-enterprise.h b/arch/arm/mach-tegra/board-enterprise.h
index c7270e6ea6f2..2713790605a3 100644
--- a/arch/arm/mach-tegra/board-enterprise.h
+++ b/arch/arm/mach-tegra/board-enterprise.h
@@ -56,6 +56,8 @@ int enterprise_suspend_init(void);
/*****************Camera GPIOs ******************/
#define CAM_CSI_MUX_SEL_GPIO TEGRA_GPIO_PM3
+#define CAM_CSI_MUX_SEL_REAR 1
+#define CAM_CSI_MUX_SEL_FRONT 0
#define CAM_LDO_1V8_EN_L_GPIO TEGRA_GPIO_PF1
#define CAM_LDO_2V8_EN_L_GPIO TEGRA_GPIO_PM7
#define CAM1_RST_L_GPIO TEGRA_GPIO_PM5 /*REAR RIGHT*/
@@ -63,7 +65,11 @@ int enterprise_suspend_init(void);
#define CAM2_RST_L_GPIO TEGRA_GPIO_PF4 /*REAR LEFT*/
#define CAM2_PWDN_GPIO TEGRA_GPIO_PF2 /*REAR LEFT*/
#define CAM3_RST_L_GPIO TEGRA_GPIO_PM2 /*FRONT*/
+#define CAM3_RST_L_TRUE 0
+#define CAM3_RST_L_FALSE 1
#define CAM3_PWDN_GPIO TEGRA_GPIO_PN4 /*FRONT*/
+#define CAM3_PWDN_TRUE 1
+#define CAM3_PWDN_FALSE 0
#define CAM_FLASH_EN_GPIO TEGRA_GPIO_PBB3
#define CAM_FLASH_MAX_TORCH_AMP 7
#define CAM_FLASH_MAX_FLASH_AMP 7
generated by cgit v1.2.3 (git 2.0.4) at 2024-11-16 12:21:42 +0000