1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
|
/*
* Copyright (C) ST-Ericsson SA 2010
*
* License terms: GNU General Public License (GPL), version 2
*/
#include <linux/gpio.h>
#include <linux/lsm303dlh.h>
#include <linux/l3g4200d.h>
#include <linux/i2c.h>
#include <linux/input/lps001wp.h>
#include <asm/mach-types.h>
#include <mach/id.h>
#include "board-mop500.h"
/*
* LSM303DLH accelerometer + magnetometer sensors
*/
static struct lsm303dlh_platform_data __initdata lsm303dlh_pdata = {
.name_a = "lsm303dlh.0",
.name_m = "lsm303dlh.1",
.axis_map_x = 0,
.axis_map_y = 1,
.axis_map_z = 2,
.negative_x = 1,
.negative_y = 1,
.negative_z = 0,
};
static struct l3g4200d_gyr_platform_data __initdata l3g4200d_pdata_u8500 = {
.name_gyr = "l3g4200d",
.axis_map_x = 1,
.axis_map_y = 0,
.axis_map_z = 2,
.negative_x = 0,
.negative_y = 0,
.negative_z = 1,
};
static struct lps001wp_prs_platform_data __initdata lps001wp_pdata = {
.poll_interval = 500,
.min_interval = 10,
};
static struct i2c_board_info __initdata mop500_i2c2_devices[] = {
{
/* LSM303DLH Magnetometer */
I2C_BOARD_INFO("lsm303dlh_m", 0x1E),
.platform_data = &lsm303dlh_pdata,
},
{
/* L3G4200D Gyroscope */
I2C_BOARD_INFO("l3g4200d", 0x68),
.platform_data = &l3g4200d_pdata_u8500,
},
{
/* LSP001WM Barometer */
I2C_BOARD_INFO("lps001wp_prs_sysfs", 0x5C),
.platform_data = &lps001wp_pdata,
},
};
/*
* Break this out due to the fact that this have changed address on snowball
*/
static struct i2c_board_info __initdata mop500_2_i2c2_devices[] = {
{
/* LSM303DLH Accelerometer */
I2C_BOARD_INFO("lsm303dlh_a", 0x18),
.platform_data = &lsm303dlh_pdata,
},
};
/*
* This is needed due to the fact that the i2c address changed in V7 =<
* and there is no way of knowing if the HW is V7 or higher so we just
* have to try and fail.
*/
static struct i2c_board_info __initdata snowball_i2c2_devices[] = {
{
/* LSM303DLH Accelerometer */
I2C_BOARD_INFO("lsm303dlhc_a", 0x19),
.platform_data = &lsm303dlh_pdata,
},
};
/*
* Register/Add i2c sensors
*/
void mop500_sensors_i2c_add(int busnum, struct i2c_board_info const *info,
unsigned n)
{
struct i2c_adapter *adap;
struct i2c_client *client;
int i;
adap = i2c_get_adapter(busnum);
if (!adap) {
/* We have no i2c adapter yet lets create it. */
pr_info(__FILE__ ": Creating i2c adapter %d\n", busnum);
i2c_register_board_info(busnum, info, n);
return;
}
for (i = 0; i < n; i++) {
client = i2c_new_device(adap, &info[i]);
if (!client)
pr_err(__FILE__ ": failed to register %s to i2c%d\n",
info[i].type,
busnum);
}
i2c_put_adapter(adap);
}
/*
* Register/Add i2c sensors
*/
void mop500_sensors_probe_add_lsm303dlh_a(void)
{
static const int busnum = 2;
int status;
struct i2c_adapter *adap;
struct i2c_client *client;
static const unsigned short i2c_addr_list[] = {
0x18, 0x19, I2C_CLIENT_END };
struct i2c_board_info i2c_info = {
/* LSM303DLH Accelerometer */
I2C_BOARD_INFO("lsm303dlh_a", 0),
.platform_data = &lsm303dlh_pdata,
};
union i2c_smbus_data data;
adap = i2c_get_adapter(busnum);
if (!adap) {
/* We have no i2c adapter yet lets create it. */
pr_err(__FILE__ ": Could not get adapter %d\n", busnum);
return;
}
client = i2c_new_probed_device(adap, &i2c_info,
i2c_addr_list, NULL);
if (!client)
pr_err(__FILE__ ": failed to register %s to i2c%d\n",
i2c_info.type,
busnum);
/* driver is different for LSM3030DLH(0x18) and LSM303DLHC(0x19)*/
if (i2c_info.addr == 0x19) {
snprintf(i2c_info.type, sizeof(i2c_info.type), "lsm303dlhc_a");
}
/*
* From the i2c_new_probed_device() function we will come to know
* the adress of the device, so read 0x0F register to get chipID.
* This chipID is used in magnetometer driver to invet co-ordinates.
*/
status = i2c_smbus_xfer(adap, i2c_info.addr , 0 ,
I2C_SMBUS_READ, 0x0F ,
I2C_SMBUS_BYTE_DATA, &data);
if (status < 0) {
pr_err(__FILE__ ": failed to read 0x0F register\n");
}
else
lsm303dlh_pdata.chip_id = data.byte;
i2c_put_adapter(adap);
}
static int __init mop500_sensors_init(void)
{
if (!machine_is_snowball() && !uib_is_stuib())
return 0;
if (machine_is_hrefv60()) {
lsm303dlh_pdata.irq_a1 = HREFV60_ACCEL_INT1_GPIO;
lsm303dlh_pdata.irq_a2 = HREFV60_ACCEL_INT2_GPIO;
lsm303dlh_pdata.irq_m = HREFV60_MAGNET_DRDY_GPIO;
} else if (machine_is_snowball()) {
lsm303dlh_pdata.irq_a1 = SNOWBALL_ACCEL_INT1_GPIO;
lsm303dlh_pdata.irq_a2 = SNOWBALL_ACCEL_INT2_GPIO;
lsm303dlh_pdata.irq_m = SNOWBALL_MAGNET_DRDY_GPIO;
} else {
lsm303dlh_pdata.irq_a1 = GPIO_ACCEL_INT1;
lsm303dlh_pdata.irq_a2 = GPIO_ACCEL_INT2;
lsm303dlh_pdata.irq_m = GPIO_MAGNET_DRDY;
}
if (machine_is_snowball()) {
if (cpu_is_u8500v21())
/* This is ugly but we cant know what address
* to use */
mop500_sensors_probe_add_lsm303dlh_a();
else {
/* Add the accelerometer with new addr */
mop500_sensors_i2c_add(2, snowball_i2c2_devices,
ARRAY_SIZE(snowball_i2c2_devices));
/* For 0x19 accelerometer chip_id is 51*/
lsm303dlh_pdata.chip_id = 51;
}
} else /* none snowball have the old addr */
mop500_sensors_i2c_add(2, mop500_2_i2c2_devices,
ARRAY_SIZE(mop500_2_i2c2_devices));
mop500_sensors_i2c_add(2, mop500_i2c2_devices,
ARRAY_SIZE(mop500_i2c2_devices));
return 0;
}
module_init(mop500_sensors_init);
|
