1 files changed, 259 insertions, 0 deletions

diff --git a/arch/arm/mach-tegra/board-kai-sensors.c b/arch/arm/mach-tegra/board-kai-sensors.c
new file mode 100644
index 00000000000..82784ebd973
--- /dev/null
+++ b/arch/arm/mach-tegra/board-kai-sensors.c
@@ -0,0 +1,259 @@
+
+/*
+ * arch/arm/mach-tegra/board-kai-sensors.c
+ *
+ * Copyright (c) 2012, NVIDIA Corporation.
+ *
+ * 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.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+#include <linux/delay.h>
+#include <linux/err.h>
+#include <linux/i2c.h>
+#include <linux/cm3217.h>
+#include <linux/mpu.h>
+#include <linux/regulator/consumer.h>
+#include <asm/mach-types.h>
+#include <mach/gpio.h>
+#include <media/ov2710.h>
+#include "board.h"
+#include "board-kai.h"
+#include "cpu-tegra.h"
+
+static struct regulator *kai_1v8_cam3;
+static struct regulator *kai_vdd_cam3;
+
+static struct cm3217_platform_data kai_cm3217_pdata = {
+        .levels = {10, 160, 225, 320, 640, 1280, 2600, 5800, 8000, 10240},
+        .golden_adc = 0,
+        .power = 0,
+};
+
+static struct i2c_board_info kai_i2c0_cm3217_board_info[] = {
+        {
+                I2C_BOARD_INFO("cm3217", 0x10),
+                .platform_data = &kai_cm3217_pdata,
+        },
+};
+
+static int kai_camera_init(void)
+{
+        int ret;
+
+        tegra_gpio_enable(CAM2_POWER_DWN_GPIO);
+        ret = gpio_request(CAM2_POWER_DWN_GPIO, "cam2_power_en");
+        if (ret < 0) {
+                pr_err("%s: gpio_request failed for gpio %s\n",
+                        __func__, "CAM2_POWER_DWN_GPIO");
+        }
+
+        gpio_direction_output(CAM2_POWER_DWN_GPIO, 1);
+        mdelay(10);
+
+        tegra_gpio_enable(CAM2_RST_GPIO);
+        ret = gpio_request(CAM2_RST_GPIO, "cam2_reset");
+        if (ret < 0) {
+                pr_err("%s: gpio_request failed for gpio %s\n",
+                        __func__, "CAM2_RST_GPIO");
+        }
+
+        gpio_direction_output(CAM2_RST_GPIO, 0);
+        mdelay(5);
+
+        return 0;
+}
+
+static int kai_ov2710_power_on(void)
+{
+        gpio_direction_output(CAM2_POWER_DWN_GPIO, 0);
+        mdelay(10);
+
+        if (kai_vdd_cam3 == NULL) {
+                kai_vdd_cam3 = regulator_get(NULL, "vdd_cam3");
+                if (WARN_ON(IS_ERR(kai_vdd_cam3))) {
+                        pr_err("%s: couldn't get regulator vdd_cam3: %d\n",
+                                __func__, PTR_ERR(kai_vdd_cam3));
+                        goto reg_get_vdd_cam3_fail;
+                }
+        }
+        regulator_enable(kai_vdd_cam3);
+
+        if (kai_1v8_cam3 == NULL) {
+                kai_1v8_cam3 = regulator_get(NULL, "vdd_1v8_cam3");
+                if (WARN_ON(IS_ERR(kai_1v8_cam3))) {
+                        pr_err("%s: couldn't get regulator vdd_1v8_cam3: %d\n",
+                                __func__, PTR_ERR(kai_1v8_cam3));
+                        goto reg_get_vdd_1v8_cam3_fail;
+                }
+        }
+        regulator_enable(kai_1v8_cam3);
+        mdelay(5);
+
+        gpio_direction_output(CAM2_RST_GPIO, 1);
+        mdelay(10);
+
+        return 0;
+
+reg_get_vdd_1v8_cam3_fail:
+        kai_1v8_cam3 = NULL;
+        regulator_put(kai_vdd_cam3);
+
+reg_get_vdd_cam3_fail:
+        kai_vdd_cam3 = NULL;
+
+        return -ENODEV;
+}
+
+static int kai_ov2710_power_off(void)
+{
+        gpio_direction_output(CAM2_POWER_DWN_GPIO, 1);
+
+        gpio_direction_output(CAM2_RST_GPIO, 0);
+
+        if (kai_1v8_cam3)
+                regulator_disable(kai_1v8_cam3);
+        if (kai_vdd_cam3)
+                regulator_disable(kai_vdd_cam3);
+
+        return 0;
+}
+
+struct ov2710_platform_data kai_ov2710_data = {
+        .power_on = kai_ov2710_power_on,
+        .power_off = kai_ov2710_power_off,
+};
+
+static struct i2c_board_info kai_i2c2_board_info[] = {
+        {
+                I2C_BOARD_INFO("ov2710", 0x36),
+                .platform_data = &kai_ov2710_data,
+        },
+};
+
+/* MPU board file definition */
+
+#if (MPU_GYRO_TYPE == MPU_TYPE_MPU3050)
+#define MPU_GYRO_NAME           "mpu3050"
+#endif
+#if (MPU_GYRO_TYPE == MPU_TYPE_MPU6050)
+#define MPU_GYRO_NAME           "mpu6050"
+#endif
+
+static struct mpu_platform_data mpu_gyro_data = {
+        .int_config     = 0x10,
+        .level_shifter  = 0,
+        .orientation    = MPU_GYRO_ORIENTATION,
+};
+
+#if (MPU_GYRO_TYPE == MPU_TYPE_MPU3050)
+static struct ext_slave_platform_data mpu_accel_data = {
+        .address        = MPU_ACCEL_ADDR,
+        .irq            = 0,
+        .adapt_num      = MPU_ACCEL_BUS_NUM,
+        .bus            = EXT_SLAVE_BUS_SECONDARY,
+        .orientation    = MPU_ACCEL_ORIENTATION,
+};
+#endif
+
+static struct ext_slave_platform_data mpu_compass_data = {
+        .address        = MPU_COMPASS_ADDR,
+        .irq            = 0,
+        .adapt_num      = MPU_COMPASS_BUS_NUM,
+        .bus            = EXT_SLAVE_BUS_PRIMARY,
+        .orientation    = MPU_COMPASS_ORIENTATION,
+};
+
+static struct i2c_board_info __initdata inv_mpu_i2c0_board_info[] = {
+        {
+                I2C_BOARD_INFO(MPU_GYRO_NAME, MPU_GYRO_ADDR),
+                .irq = TEGRA_GPIO_TO_IRQ(MPU_GYRO_IRQ_GPIO),
+                .platform_data = &mpu_gyro_data,
+        },
+#if (MPU_GYRO_TYPE == MPU_TYPE_MPU3050)
+        {
+                I2C_BOARD_INFO(MPU_ACCEL_NAME, MPU_ACCEL_ADDR),
+#if MPU_ACCEL_IRQ_GPIO
+                .irq = TEGRA_GPIO_TO_IRQ(MPU_ACCEL_IRQ_GPIO),
+#endif
+                .platform_data = &mpu_accel_data,
+        },
+#endif
+        {
+                I2C_BOARD_INFO(MPU_COMPASS_NAME, MPU_COMPASS_ADDR),
+#if MPU_COMPASS_IRQ_GPIO
+                .irq = TEGRA_GPIO_TO_IRQ(MPU_COMPASS_IRQ_GPIO),
+#endif
+                .platform_data = &mpu_compass_data,
+        },
+};
+
+static void mpuirq_init(void)
+{
+        int ret = 0;
+
+        pr_info("*** MPU START *** mpuirq_init...\n");
+
+#if (MPU_GYRO_TYPE == MPU_TYPE_MPU3050)
+#if MPU_ACCEL_IRQ_GPIO
+        /* ACCEL-IRQ assignment */
+        tegra_gpio_enable(MPU_ACCEL_IRQ_GPIO);
+        ret = gpio_request(MPU_ACCEL_IRQ_GPIO, MPU_ACCEL_NAME);
+        if (ret < 0) {
+                pr_err("%s: gpio_request failed %d\n", __func__, ret);
+                return;
+        }
+
+        ret = gpio_direction_input(MPU_ACCEL_IRQ_GPIO);
+        if (ret < 0) {
+                pr_err("%s: gpio_direction_input failed %d\n", __func__, ret);
+                gpio_free(MPU_ACCEL_IRQ_GPIO);
+                return;
+        }
+#endif
+#endif
+
+        /* MPU-IRQ assignment */
+        tegra_gpio_enable(MPU_GYRO_IRQ_GPIO);
+        ret = gpio_request(MPU_GYRO_IRQ_GPIO, MPU_GYRO_NAME);
+        if (ret < 0) {
+                pr_err("%s: gpio_request failed %d\n", __func__, ret);
+                return;
+        }
+
+        ret = gpio_direction_input(MPU_GYRO_IRQ_GPIO);
+        if (ret < 0) {
+                pr_err("%s: gpio_direction_input failed %d\n", __func__, ret);
+                gpio_free(MPU_GYRO_IRQ_GPIO);
+                return;
+        }
+        pr_info("*** MPU END *** mpuirq_init...\n");
+
+        i2c_register_board_info(MPU_GYRO_BUS_NUM, inv_mpu_i2c0_board_info,
+                ARRAY_SIZE(inv_mpu_i2c0_board_info));
+}
+
+int __init kai_sensors_init(void)
+{
+        kai_camera_init();
+
+        i2c_register_board_info(2, kai_i2c2_board_info,
+                ARRAY_SIZE(kai_i2c2_board_info));
+
+        i2c_register_board_info(0, kai_i2c0_cm3217_board_info,
+                ARRAY_SIZE(kai_i2c0_cm3217_board_info));
+
+        mpuirq_init();
+
+        return 0;
+}