Michael Limbird / Mbed 2 deprecated VideoOutput

Dependencies:   mbed

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?

UserRevisionLine numberNew 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 */