-
Notifications
You must be signed in to change notification settings - Fork 0
/
bmp.c
235 lines (186 loc) · 5.49 KB
/
bmp.c
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
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
/*
Raspberry Pi Bosch BMP085 communication code.
*/
#include <math.h>
#include <stdio.h>
#include <stdint.h>
#include <fcntl.h>
#include <stdlib.h>
#include <unistd.h>
#include <linux/i2c-dev.h>
#include <linux/i2c.h>
#include <sys/ioctl.h>
#include "smbus.h"
#define BMP085_I2C_ADDRESS 0x77
const unsigned char BMP085_OVERSAMPLING_SETTING = 3;
// Calibration values - These are stored in the BMP085
short int ac1;
short int ac2;
short int ac3;
unsigned short int ac4;
unsigned short int ac5;
unsigned short int ac6;
short int b1;
short int b2;
short int mb;
short int mc;
short int md;
int b5;
unsigned int temperature, pressure, altitude;
// Open a connection to the bmp085
// Returns a file id
int bmp085_i2c_Begin()
{
int fd;
char *fileName = "/dev/i2c-1";
// Open port for reading and writing
if ((fd = open(fileName, O_RDWR)) < 0)
exit(1);
// Set the port options and set the address of the device
if (ioctl(fd, I2C_SLAVE, BMP085_I2C_ADDRESS) < 0) {
close(fd);
exit(1);
}
return fd;
}
// Read two words from the BMP085 and supply it as a 16 bit integer
__s32 bmp085_i2c_Read_Int(int fd, __u8 address)
{
__s32 res = i2c_smbus_read_word_data(fd, address);
if (res < 0) {
close(fd);
exit(1);
}
// Convert result to 16 bits and swap bytes
res = ((res<<8) & 0xFF00) | ((res>>8) & 0xFF);
return res;
}
//Write a byte to the BMP085
void bmp085_i2c_Write_Byte(int fd, __u8 address, __u8 value)
{
if (i2c_smbus_write_byte_data(fd, address, value) < 0) {
close(fd);
exit(1);
}
}
// Read a block of data BMP085
void bmp085_i2c_Read_Block(int fd, __u8 address, __u8 length, __u8 *values)
{
if(i2c_smbus_read_i2c_block_data(fd, address,length,values)<0) {
close(fd);
exit(1);
}
}
unsigned int bmp085_Calibration(int fd)
{
if (fd > 0){
ac1 = bmp085_i2c_Read_Int(fd,0xAA);
ac2 = bmp085_i2c_Read_Int(fd,0xAC);
ac3 = bmp085_i2c_Read_Int(fd,0xAE);
ac4 = bmp085_i2c_Read_Int(fd,0xB0);
ac5 = bmp085_i2c_Read_Int(fd,0xB2);
ac6 = bmp085_i2c_Read_Int(fd,0xB4);
b1 = bmp085_i2c_Read_Int(fd,0xB6);
b2 = bmp085_i2c_Read_Int(fd,0xB8);
mb = bmp085_i2c_Read_Int(fd,0xBA);
mc = bmp085_i2c_Read_Int(fd,0xBC);
md = bmp085_i2c_Read_Int(fd,0xBE);
return fd;
}
return 0;
}
// Read the uncompensated temperature value
unsigned int bmp085_ReadUT(int fd)
{
unsigned int ut = 0;
// Write 0x2E into Register 0xF4
// This requests a temperature reading
bmp085_i2c_Write_Byte(fd,0xF4,0x2E);
// Wait at least 4.5ms
usleep(5000);
// Read the two byte result from address 0xF6
ut = bmp085_i2c_Read_Int(fd,0xF6);
return ut;
}
// Read the uncompensated pressure value
unsigned int bmp085_ReadUP(int fd)
{
unsigned int up = 0;
// Write 0x34+(BMP085_OVERSAMPLING_SETTING<<6) into register 0xF4
// Request a pressure reading w/ oversampling setting
bmp085_i2c_Write_Byte(fd,0xF4,0x34 + (BMP085_OVERSAMPLING_SETTING<<6));
// Wait for conversion, delay time dependent on oversampling setting
usleep((2 + (3<<BMP085_OVERSAMPLING_SETTING)) * 1000);
// Read the three byte result from 0xF6
// 0xF6 = MSB, 0xF7 = LSB and 0xF8 = XLSB
__u8 values[3];
bmp085_i2c_Read_Block(fd, 0xF6, 3, values);
up = (((unsigned int) values[0] << 16) | ((unsigned int) values[1] << 8) | (unsigned int) values[2]) >> (8-BMP085_OVERSAMPLING_SETTING);
return up;
}
// Calculate pressure given uncalibrated pressure
// Value returned will be in units of XXXXX
unsigned int bmp085_GetPressure(unsigned int up)
{
int x1, x2, x3, b3, b6, p, p0;
unsigned int b4, b7;
b6 = b5 - 4000;
// Calculate B3
x1 = (b2 * (b6 * b6)>>12)>>11;
x2 = (ac2 * b6)>>11;
x3 = x1 + x2;
b3 = (((((int)ac1)*4 + x3)<<BMP085_OVERSAMPLING_SETTING) + 2)>>2;
// Calculate B4
x1 = (ac3 * b6)>>13;
x2 = (b1 * ((b6 * b6)>>12))>>16;
x3 = ((x1 + x2) + 2)>>2;
b4 = (ac4 * (unsigned int)(x3 + 32768))>>15;
b7 = ((unsigned int)(up - b3) * (50000>>BMP085_OVERSAMPLING_SETTING));
if (b7 < 0x80000000)
p = (b7<<1)/b4;
else
p = (b7/b4)<<1;
x1 = (p>>8) * (p>>8);
x1 = (x1 * 3038)>>16;
x2 = (-7357 * p)>>16;
p += (x1 + x2 + 3791)>>4;
// Calculates the pressure at sealevel when given a known altitude in meters. Returns a value in Pascals.
p0 = p / pow(1.0 - 51/44330.0, 5.255);
return p0;
}
// Calculate temperature given uncalibrated temperature
// Value returned will be in units of 0.1 deg C
unsigned int bmp085_GetTemperature(unsigned int ut)
{
int x1, x2;
x1 = (((int)ut - (int)ac6)*(int)ac5) >> 15;
x2 = ((int)mc << 11)/(x1 + md);
b5 = x1 + x2;
unsigned int result = ((b5 + 8)>>4);
return result;
}
// This Altitude part is stolen from some some unknown
// Arduino library. The number divided into pressure for
// float A is derived from the local pressure as explained
// at http://learn.adafruit.com/bmp085/using-the-bmp085.
unsigned int bmp085_Altitude(float p0)
{
float A = p0/101794.58;
float B = 1/5.25588;
float C = pow(A,B);
C = 1 - C;
C = C / 0.0000225577;
return C;
}
/*
int main(int argc, char **argv)
{
bmp085_Calibration();
temperature = bmp085_GetTemperature(bmp085_ReadUT());
pressure = bmp085_GetPressure(bmp085_ReadUP());
// altitude = bmp085_Altitude(pressure);
printf("Temperature\t%0.1f *C\n", ((double)temperature)/10);
printf("Pressure\t%0.2f hPa\n", ((double)pressure)/100);
// printf("Altitude\t%0.1f Feet\n", ((double)altitude)*3.280839895);
return 0;
}*/