Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
main.cpp@12:509ed716bd58, 2015-01-10 (annotated)
- Committer:
- mlimbird
- Date:
- Sat Jan 10 19:24:38 2015 +0000
- Revision:
- 12:509ed716bd58
- Parent:
- 11:65ae1cf6f7d9
- Child:
- 13:83bea035c658
Accelerometer data is able to be read.
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| mlimbird | 0:80725699690f | 1 | #include "mbed.h" |
| mlimbird | 0:80725699690f | 2 | |
| mlimbird | 8:c64f76d4deff | 3 | //Accelerometer |
| mlimbird | 11:65ae1cf6f7d9 | 4 | #define ADXL345_ADDRESS (0xA6 >> 1) //I2C uses 7 bits, must shift it by 1 to use |
| mlimbird | 8:c64f76d4deff | 5 | #define ADXL345_REGISTER_XLSB (0x32) |
| mlimbird | 8:c64f76d4deff | 6 | #define ADXL_REGISTER_PWRCTL (0x2D) |
| mlimbird | 11:65ae1cf6f7d9 | 7 | #define ADXL_PWRCTL_MEASURE (0x01 << 3) |
| mlimbird | 8:c64f76d4deff | 8 | |
| mlimbird | 8:c64f76d4deff | 9 | //Gyroscope |
| mlimbird | 8:c64f76d4deff | 10 | #define ITG3200_ADDRESS (0xD0 >> 1) |
| mlimbird | 8:c64f76d4deff | 11 | #define ITG3200_REGISTER_XMSB (0x1D) |
| mlimbird | 8:c64f76d4deff | 12 | #define ITG3200_REGISTER_DLPF_FS (0x16) |
| mlimbird | 8:c64f76d4deff | 13 | #define ITG3200_FULLSCALE (0x03 << 3) |
| mlimbird | 8:c64f76d4deff | 14 | #define ITG3200_42HZ (0x03) |
| mlimbird | 8:c64f76d4deff | 15 | |
| mlimbird | 8:c64f76d4deff | 16 | //3-Axis Digital Compass IC |
| mlimbird | 8:c64f76d4deff | 17 | #define HMC5843_ADDRESS (0x3C >> 1) |
| mlimbird | 8:c64f76d4deff | 18 | #define HMC5843_REGISTER_XMSB (0x03) |
| mlimbird | 8:c64f76d4deff | 19 | #define HMC5843_REGISTER_MEASMODE (0x02) |
| mlimbird | 8:c64f76d4deff | 20 | #define HMC5843_MEASMODE_CONT (0x00) |
| mlimbird | 8:c64f76d4deff | 21 | |
| mlimbird | 11:65ae1cf6f7d9 | 22 | I2C i2c( p9, p10 ); // sda, scl |
| mlimbird | 8:c64f76d4deff | 23 | |
| mlimbird | 11:65ae1cf6f7d9 | 24 | void init_adxl345(); |
| mlimbird | 8:c64f76d4deff | 25 | //void init_itg3200(); |
| mlimbird | 8:c64f76d4deff | 26 | //void init_hmc5843(); |
| mlimbird | 8:c64f76d4deff | 27 | |
| mlimbird | 8:c64f76d4deff | 28 | Serial pc(USBTX, USBRX); //tx, rx |
| mlimbird | 8:c64f76d4deff | 29 | |
| mlimbird | 12:509ed716bd58 | 30 | int accelerometer_data[3]; |
| mlimbird | 12:509ed716bd58 | 31 | //int gyro_data[3]; |
| mlimbird | 12:509ed716bd58 | 32 | //int magnetometer_data[3]; |
| mlimbird | 8:c64f76d4deff | 33 | |
| mlimbird | 9:331dbf3b341d | 34 | PwmOut led(LED1); |
| mlimbird | 9:331dbf3b341d | 35 | |
| mlimbird | 9:331dbf3b341d | 36 | float brightness = 0.0; |
| mlimbird | 0:80725699690f | 37 | |
| mlimbird | 0:80725699690f | 38 | int main() { |
| mlimbird | 8:c64f76d4deff | 39 | |
| mlimbird | 11:65ae1cf6f7d9 | 40 | init_adxl345(); |
| mlimbird | 8:c64f76d4deff | 41 | //init_hmc5843(); |
| mlimbird | 8:c64f76d4deff | 42 | //init_itg3200(); |
| mlimbird | 7:4377556c2d5b | 43 | |
| mlimbird | 12:509ed716bd58 | 44 | //pc.printf("Press 'u' to turn LED1 brightness up, 'd' to turn it down.\n"); |
| mlimbird | 9:331dbf3b341d | 45 | |
| mlimbird | 12:509ed716bd58 | 46 | while(1) { |
| mlimbird | 12:509ed716bd58 | 47 | /* |
| mlimbird | 9:331dbf3b341d | 48 | char c = pc.getc(); |
| mlimbird | 9:331dbf3b341d | 49 | if((c == 'u') && (brightness < 0.5)) { |
| mlimbird | 9:331dbf3b341d | 50 | brightness += 0.01; |
| mlimbird | 9:331dbf3b341d | 51 | led = brightness; |
| mlimbird | 9:331dbf3b341d | 52 | } |
| mlimbird | 9:331dbf3b341d | 53 | if((c == 'd') && (brightness > 0.0)) { |
| mlimbird | 9:331dbf3b341d | 54 | brightness -= 0.01; |
| mlimbird | 9:331dbf3b341d | 55 | led = brightness; |
| mlimbird | 9:331dbf3b341d | 56 | } |
| mlimbird | 12:509ed716bd58 | 57 | */ |
| mlimbird | 12:509ed716bd58 | 58 | |
| mlimbird | 12:509ed716bd58 | 59 | pc.printf("ACCEL: %i\t%i\t%i\n", accelerometer_data[0], accelerometer_data[1], accelerometer_data[2]); |
| mlimbird | 7:4377556c2d5b | 60 | |
| mlimbird | 0:80725699690f | 61 | } |
| mlimbird | 0:80725699690f | 62 | } |
| mlimbird | 8:c64f76d4deff | 63 | |
| mlimbird | 8:c64f76d4deff | 64 | void init_adxl345() { |
| mlimbird | 11:65ae1cf6f7d9 | 65 | char data[2]; |
| mlimbird | 11:65ae1cf6f7d9 | 66 | data[0] = ADXL_REGISTER_PWRCTL; |
| mlimbird | 11:65ae1cf6f7d9 | 67 | data[1] = ADXL_PWRCTL_MEASURE; |
| mlimbird | 8:c64f76d4deff | 68 | |
| mlimbird | 11:65ae1cf6f7d9 | 69 | i2c.write(ADXL345_ADDRESS, data, 2); // first part of data is the register |
| mlimbird | 11:65ae1cf6f7d9 | 70 | |
| mlimbird | 11:65ae1cf6f7d9 | 71 | wait(0.5); |
| mlimbird | 8:c64f76d4deff | 72 | |
| mlimbird | 11:65ae1cf6f7d9 | 73 | i2c.write(ADXL345_ADDRESS, data, 1); |
| mlimbird | 11:65ae1cf6f7d9 | 74 | i2c.read(ADXL345_ADDRESS, data, 2); |
| mlimbird | 12:509ed716bd58 | 75 | pc.printf("%i\n",(unsigned int)data); |
| mlimbird | 8:c64f76d4deff | 76 | } |
| mlimbird | 8:c64f76d4deff | 77 | |
| mlimbird | 8:c64f76d4deff | 78 | void read_adxl345() { |
| mlimbird | 12:509ed716bd58 | 79 | char bytes[6]; |
| mlimbird | 8:c64f76d4deff | 80 | memset(bytes,0,6); |
| mlimbird | 12:509ed716bd58 | 81 | bytes[0] = ADXL345_REGISTER_XLSB; |
| mlimbird | 12:509ed716bd58 | 82 | |
| mlimbird | 12:509ed716bd58 | 83 | i2c.write(ADXL345_ADDRESS, bytes, 1); |
| mlimbird | 12:509ed716bd58 | 84 | i2c.read(ADXL345_ADDRESS, bytes, 6); |
| mlimbird | 8:c64f76d4deff | 85 | |
| mlimbird | 8:c64f76d4deff | 86 | for (int i=0;i<3;++i) { |
| mlimbird | 8:c64f76d4deff | 87 | accelerometer_data[i] = (int)bytes[2*i] + (((int)bytes[2*i + 1]) << 8); |
| mlimbird | 8:c64f76d4deff | 88 | } |
| mlimbird | 8:c64f76d4deff | 89 | } |
| mlimbird | 8:c64f76d4deff | 90 | |
| mlimbird | 12:509ed716bd58 | 91 | /* |
| mlimbird | 8:c64f76d4deff | 92 | void init_itg3200() { |
| mlimbird | 8:c64f76d4deff | 93 | byte data = 0; |
| mlimbird | 8:c64f76d4deff | 94 | |
| mlimbird | 8:c64f76d4deff | 95 | i2c_write(ITG3200_ADDRESS, ITG3200_REGISTER_DLPF_FS, ITG3200_FULLSCALE | ITG3200_42HZ); |
| mlimbird | 8:c64f76d4deff | 96 | |
| mlimbird | 8:c64f76d4deff | 97 | i2c_read(ITG3200_ADDRESS, ITG3200_REGISTER_DLPF_FS, 1, &data); |
| mlimbird | 8:c64f76d4deff | 98 | |
| mlimbird | 8:c64f76d4deff | 99 | Serial.println((unsigned int)data); |
| mlimbird | 8:c64f76d4deff | 100 | } |
| mlimbird | 8:c64f76d4deff | 101 | |
| mlimbird | 8:c64f76d4deff | 102 | void read_itg3200() { |
| mlimbird | 8:c64f76d4deff | 103 | bytes bytes[6]; |
| mlimbird | 8:c64f76d4deff | 104 | memset(bytes,0,6); |
| mlimbird | 8:c64f76d4deff | 105 | |
| mlimbird | 8:c64f76d4deff | 106 | i2c_read(ITG3200_ADDRESS, ITG3200_REGISTER_XMSB, 6, bytes); |
| mlimbird | 8:c64f76d4deff | 107 | for (int i=0;i<3;++i) { |
| mlimbird | 8:c64f76d4deff | 108 | gyro_data[i] = (int)bytes[2*i + 1] + (((int)bytes[2*i]) << 8); |
| mlimbird | 8:c64f76d4deff | 109 | } |
| mlimbird | 8:c64f76d4deff | 110 | } |
| mlimbird | 8:c64f76d4deff | 111 | |
| mlimbird | 8:c64f76d4deff | 112 | void init_hmc5843() { |
| mlimbird | 8:c64f76d4deff | 113 | bytes data = 0; |
| mlimbird | 8:c64f76d4deff | 114 | |
| mlimbird | 8:c64f76d4deff | 115 | i2c_write(HMC5843_ADDRESS, HMC5843_REGISTER_MEASMODE, HMC5843_MEASMODE_CONT); |
| mlimbird | 8:c64f76d4deff | 116 | |
| mlimbird | 8:c64f76d4deff | 117 | i2c_read(HMC5843_ADDRESS, HMC5843_REGISTER_MEASMODE, 1, &data); |
| mlimbird | 8:c64f76d4deff | 118 | Serial.println((unsigned int)data); |
| mlimbird | 8:c64f76d4deff | 119 | } |
| mlimbird | 8:c64f76d4deff | 120 | |
| mlimbird | 8:c64f76d4deff | 121 | void read_hmc5843() { |
| mlimbird | 8:c64f76d4deff | 122 | bytes bytes[6]; |
| mlimbird | 8:c64f76d4deff | 123 | memset(bytes,0,6); |
| mlimbird | 8:c64f76d4deff | 124 | |
| mlimbird | 8:c64f76d4deff | 125 | i2c_read(HMC5843_ADDRESS, HMC5843_REGISTER_XMSB, 6, bytes); |
| mlimbird | 8:c64f76d4deff | 126 | |
| mlimbird | 8:c64f76d4deff | 127 | for (int i=0;i<3;++i) { |
| mlimbird | 8:c64f76d4deff | 128 | magnetometer_data[i] = (int)bytes[2*i + 1] + (((int)bytes[2*i]) << 8); |
| mlimbird | 8:c64f76d4deff | 129 | } |
| mlimbird | 8:c64f76d4deff | 130 | } |
| mlimbird | 8:c64f76d4deff | 131 | */ |