arch/arm/mach-omap2/board-tuna-sensors.c

   1 /* Sensor support for Samsung Tuna Board.
   2  *
   3  * Copyright (C) 2011 Google, Inc.
   4  *
   5  * This software is licensed under the terms of the GNU General Public
   6  * License version 2, as published by the Free Software Foundation, and
   7  * may be copied, distributed, and modified under those terms.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  */
  14
  15 #include <linux/kernel.h>
  16 #include <linux/gpio.h>
  17 #include <linux/i2c.h>
  18 #include <linux/mpu.h>
  19 #include <linux/gp2a.h>
  20 #include <linux/i2c/twl6030-madc.h>
  21
  22 #include "mux.h"
  23 #include "board-tuna.h"
  24
  25 #define GPIO_GYRO_INT           45
  26 #define GPIO_ACC_INT            122
  27 #define GPIO_MAG_INT            176
  28 #define GPIO_PS_ON              25
  29 #define GPIO_PS_VOUT            21
  30 #define GPIO_MSENSE_IRQ         157
  31
  32 #define GP2A_LIGHT_ADC_CHANNEL  4
  33
  34 static int gp2a_light_adc_value(void)
  35 {
  36         return twl6030_get_madc_conversion(GP2A_LIGHT_ADC_CHANNEL);
  37 }
  38
  39 static void gp2a_power(bool on)
  40 {
  41         /* this controls the power supply rail to the gp2a IC */
  42         gpio_set_value(GPIO_PS_ON, on);
  43 }
  44
  45 static void gp2a_gpio_init(void)
  46 {
  47         int ret = gpio_request(GPIO_PS_ON, "gp2a_power_supply_on");
  48         if (ret) {
  49                 pr_err("%s Failed to request gpio gp2a power supply\n",
  50                         __func__);
  51                 return;
  52         }
  53         /* set power pin to output, initially powered off*/
  54         ret = gpio_direction_output(GPIO_PS_ON, 0);
  55         if (ret) {
  56                 pr_err("%s Failed in gpio_direction_output, value 0 with error %d\n",
  57                         __func__, ret);
  58         }
  59 }
  60
  61 static s8 orientation_back[] = {
  62         -1,  0,  0,
  63          0,  1,  0,
  64          0,  0, -1,
  65 };
  66
  67 static s8 orientation_back_right_90[] = {
  68          0, -1,  0,
  69         -1,  0,  0,
  70          0,  0, -1,
  71 };
  72
  73 static s8 orientation_back_left_90[] = {
  74          0,  1,  0,
  75          1,  0,  0,
  76          0,  0, -1,
  77 };
  78
  79 static s8 orientation_back_180[] = {
  80          1,  0,  0,
  81          0, -1,  0,
  82          0,  0, -1,
  83 };
  84
  85 /*
  86  * A correction matrix for YAS530
  87  * which takes care of soft iron effect in TORO
  88  */
  89 static s32 compass_correction_matrix_toro[] = {
  90         1072,   -51,    -22,
  91         -30,    910,    -4,
  92         -23,    -63,    1024,
  93 };
  94
  95 static void rotcpy(s8 dst[3 * 3], const s8 src[3 * 3])
  96 {
  97         memcpy(dst, src, 3 * 3);
  98 }
  99
 100 static struct mpu_platform_data mpu_data = {
 101         .int_config  = 0x10,
 102         .orientation = {  1,  0,  0,
 103                           0,  1,  0,
 104                           0,  0,  1 },
 105         /* accel */
 106         .accel = {
 107                 .irq = OMAP_GPIO_IRQ(GPIO_ACC_INT),
 108                 .adapt_num   = 4,
 109                 .bus         = EXT_SLAVE_BUS_SECONDARY,
 110                 .address     = 0x18,
 111                 .orientation = {  1,  0,  0,
 112                                   0,  1,  0,
 113                                   0,  0,  1 },
 114         },
 115         /* compass */
 116         .compass = {
 117                 .irq = OMAP_GPIO_IRQ(GPIO_MAG_INT),
 118                 .adapt_num   = 4,
 119                 .bus         = EXT_SLAVE_BUS_PRIMARY,
 120                 .address     = 0x2E,
 121                 .orientation = {  1,  0,  0,
 122                                   0,  1,  0,
 123                                   0,  0,  1 },
 124         },
 125 };
 126
 127 static struct gp2a_platform_data gp2a_pdata = {
 128         .power = gp2a_power,
 129         .p_out = GPIO_PS_VOUT,
 130         .light_adc_value = gp2a_light_adc_value,
 131 };
 132
 133 static struct i2c_board_info __initdata tuna_sensors_i2c4_boardinfo[] = {
 134         {
 135                 I2C_BOARD_INFO("mpu3050", 0x68),
 136                 .irq = OMAP_GPIO_IRQ(GPIO_GYRO_INT),
 137                 .platform_data = &mpu_data,
 138         },
 139         {
 140                 I2C_BOARD_INFO("bma250", 0x18),
 141                 .irq = OMAP_GPIO_IRQ(GPIO_ACC_INT),
 142                 .platform_data = &mpu_data.accel,
 143         },
 144         {
 145                 I2C_BOARD_INFO("yas530", 0x2e),
 146                 .irq = OMAP_GPIO_IRQ(GPIO_MAG_INT),
 147                 .platform_data = &mpu_data.compass,
 148         },
 149         {
 150                 I2C_BOARD_INFO("gp2a", 0x44),
 151                 .platform_data = &gp2a_pdata,
 152         },
 153         {
 154                 I2C_BOARD_INFO("bmp180", 0x77),
 155         },
 156 };
 157
 158 static void omap4_tuna_fixup_orientations_maguro(int revision)
 159 {
 160         if (revision >= 3) {
 161                 rotcpy(mpu_data.orientation, orientation_back_right_90);
 162                 rotcpy(mpu_data.accel.orientation, orientation_back_left_90);
 163         } else if (revision >= 2) {
 164                 rotcpy(mpu_data.orientation, orientation_back_right_90);
 165                 rotcpy(mpu_data.accel.orientation, orientation_back_180);
 166         } else if (revision == 1) {
 167                 rotcpy(mpu_data.accel.orientation, orientation_back_left_90);
 168         }
 169 }
 170
 171 static void omap4_tuna_fixup_orientations_toro(int revision)
 172 {
 173         pr_info("HW %d", revision);
 174         if (revision >= 14) {
 175                 rotcpy(mpu_data.orientation, orientation_back_left_90);
 176                 rotcpy(mpu_data.accel.orientation, orientation_back);
 177                 rotcpy(mpu_data.compass.orientation, orientation_back);
 178         } else if (revision >= 2) {
 179                 rotcpy(mpu_data.orientation, orientation_back_left_90);
 180                 rotcpy(mpu_data.accel.orientation, orientation_back);
 181                 rotcpy(mpu_data.compass.orientation, orientation_back_180);
 182         } else if (revision >= 1) {
 183                 rotcpy(mpu_data.orientation, orientation_back_left_90);
 184                 rotcpy(mpu_data.accel.orientation, orientation_back_180);
 185                 rotcpy(mpu_data.compass.orientation, orientation_back_left_90);
 186         }
 187 }
 188
 189 void __init omap4_tuna_sensors_init(void)
 190 {
 191         omap_mux_init_gpio(GPIO_GYRO_INT, OMAP_PIN_INPUT);
 192         omap_mux_init_gpio(GPIO_ACC_INT, OMAP_PIN_INPUT);
 193         omap_mux_init_gpio(GPIO_MAG_INT, OMAP_PIN_INPUT);
 194         omap_mux_init_gpio(GPIO_PS_ON, OMAP_PIN_OUTPUT);
 195         omap_mux_init_gpio(GPIO_PS_VOUT, OMAP_WAKEUP_EN | OMAP_PIN_INPUT);
 196
 197         gpio_request(GPIO_GYRO_INT, "GYRO_INT");
 198         gpio_direction_input(GPIO_GYRO_INT);
 199         gpio_request(GPIO_ACC_INT, "ACC_INT");
 200         gpio_direction_input(GPIO_ACC_INT);
 201         gpio_request(GPIO_MAG_INT, "MAG_INT");
 202         gpio_direction_input(GPIO_MAG_INT);
 203         gpio_request(GPIO_MSENSE_IRQ, "MSENSE_IRQ");
 204         gpio_direction_output(GPIO_MSENSE_IRQ, 1);
 205         /* optical sensor */
 206         gp2a_gpio_init();
 207
 208         if (omap4_tuna_get_type() == TUNA_TYPE_MAGURO) {
 209                 omap4_tuna_fixup_orientations_maguro(omap4_tuna_get_revision());
 210         } else if (omap4_tuna_get_type() == TUNA_TYPE_TORO) {
 211                 omap4_tuna_fixup_orientations_toro(omap4_tuna_get_revision());
 212                 mpu_data.compass.private_data = compass_correction_matrix_toro;
 213         }
 214
 215         i2c_register_board_info(4, tuna_sensors_i2c4_boardinfo,
 216                                 ARRAY_SIZE(tuna_sensors_i2c4_boardinfo));
 217 }