Michael Limbird / Mbed 2 deprecated VideoOutput

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.

Dependencies:   mbed

main.cpp@10:7bdbc8eb0d69, 2015-01-10 (annotated)

Committer:
mlimbird
Date:
Sat Jan 10 15:41:56 2015 +0000
Revision:
10:7bdbc8eb0d69
Parent:
9:331dbf3b341d
Child:
11:65ae1cf6f7d9
Get ready to do 9DOF

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 8:c64f76d4deff 4 #define ADXL345_ADDRESS (0xA6 >> 1)
mlimbird 8:c64f76d4deff 5 #define ADXL345_REGISTER_XLSB (0x32)
mlimbird 8:c64f76d4deff 6 #define ADXL_REGISTER_PWRCTL (0x2D)
mlimbird 8:c64f76d4deff 7 #define ADXL_PWRCTL_MEASURE (1 << 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 8:c64f76d4deff 22 //I2C i2c( p9, p10 ); // sda, scl
mlimbird 8:c64f76d4deff 23
mlimbird 8:c64f76d4deff 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 const int addr = 0x90;
mlimbird 8:c64f76d4deff 29 Serial pc(USBTX, USBRX); //tx, rx
mlimbird 8:c64f76d4deff 30
mlimbird 10:7bdbc8eb0d69 31 //int adxl345_Data[3];
mlimbird 8:c64f76d4deff 32 //int itg3200_Data[3];
mlimbird 8:c64f76d4deff 33 //int hmc5843_Data[3];
mlimbird 8:c64f76d4deff 34
mlimbird 9:331dbf3b341d 35 PwmOut led(LED1);
mlimbird 9:331dbf3b341d 36
mlimbird 9:331dbf3b341d 37 float brightness = 0.0;
mlimbird 0:80725699690f 38
mlimbird 0:80725699690f 39 int main() {
mlimbird 9:331dbf3b341d 40 //char cmd[2];
mlimbird 8:c64f76d4deff 41
mlimbird 8:c64f76d4deff 42 //init_adxl345();
mlimbird 8:c64f76d4deff 43 //init_hmc5843();
mlimbird 8:c64f76d4deff 44 //init_itg3200();
mlimbird 7:4377556c2d5b 45
mlimbird 9:331dbf3b341d 46 pc.printf("Press 'u' to turn LED1 brightness up, 'd' to turn it down.\n");
mlimbird 9:331dbf3b341d 47
mlimbird 0:80725699690f 48 while(1) {
mlimbird 9:331dbf3b341d 49 //cmd[0] = 0x01;
mlimbird 9:331dbf3b341d 50 //cmd[1] = 0x00;
mlimbird 8:c64f76d4deff 51 //i2c.write(addr, cmd, 2); // i2c.write(address, command, bytes);
mlimbird 8:c64f76d4deff 52
mlimbird 9:331dbf3b341d 53 char c = pc.getc();
mlimbird 9:331dbf3b341d 54 if((c == 'u') && (brightness < 0.5)) {
mlimbird 9:331dbf3b341d 55 brightness += 0.01;
mlimbird 9:331dbf3b341d 56 led = brightness;
mlimbird 9:331dbf3b341d 57 }
mlimbird 9:331dbf3b341d 58 if((c == 'd') && (brightness > 0.0)) {
mlimbird 9:331dbf3b341d 59 brightness -= 0.01;
mlimbird 9:331dbf3b341d 60 led = brightness;
mlimbird 9:331dbf3b341d 61 }
mlimbird 7:4377556c2d5b 62
mlimbird 0:80725699690f 63 }
mlimbird 0:80725699690f 64 }
mlimbird 8:c64f76d4deff 65
mlimbird 8:c64f76d4deff 66
mlimbird 8:c64f76d4deff 67 /*
mlimbird 8:c64f76d4deff 68 void init_adxl345() {
mlimbird 8:c64f76d4deff 69 char data = 0;
mlimbird 8:c64f76d4deff 70
mlimbird 8:c64f76d4deff 71 i2c_write(ADXL345_ADDRESS, ADXL_REGISTER_PWRCTL, ADXL_PWRCTL_MEASURE);
mlimbird 8:c64f76d4deff 72
mlimbird 8:c64f76d4deff 73 i2c_read(ADXL345_ADDRESS, ADXL_REGISTER_PWRCTL, 1, &data);
mlimbird 8:c64f76d4deff 74 Serial.println((unsigned int)data);
mlimbird 8:c64f76d4deff 75 }
mlimbird 8:c64f76d4deff 76
mlimbird 8:c64f76d4deff 77 void read_adxl345() {
mlimbird 8:c64f76d4deff 78 bytes bytes[6];
mlimbird 8:c64f76d4deff 79 memset(bytes,0,6);
mlimbird 8:c64f76d4deff 80
mlimbird 8:c64f76d4deff 81 i2c_read(ADXL345_ADDRESS, ADXL345_REGISTER_XLSB, 6, bytes);
mlimbird 8:c64f76d4deff 82
mlimbird 8:c64f76d4deff 83 for (int i=0;i<3;++i) {
mlimbird 8:c64f76d4deff 84 accelerometer_data[i] = (int)bytes[2*i] + (((int)bytes[2*i + 1]) << 8);
mlimbird 8:c64f76d4deff 85 }
mlimbird 8:c64f76d4deff 86 }
mlimbird 8:c64f76d4deff 87
mlimbird 8:c64f76d4deff 88 void init_itg3200() {
mlimbird 8:c64f76d4deff 89 byte data = 0;
mlimbird 8:c64f76d4deff 90
mlimbird 8:c64f76d4deff 91 i2c_write(ITG3200_ADDRESS, ITG3200_REGISTER_DLPF_FS, ITG3200_FULLSCALE | ITG3200_42HZ);
mlimbird 8:c64f76d4deff 92
mlimbird 8:c64f76d4deff 93 i2c_read(ITG3200_ADDRESS, ITG3200_REGISTER_DLPF_FS, 1, &data);
mlimbird 8:c64f76d4deff 94
mlimbird 8:c64f76d4deff 95 Serial.println((unsigned int)data);
mlimbird 8:c64f76d4deff 96 }
mlimbird 8:c64f76d4deff 97
mlimbird 8:c64f76d4deff 98 void read_itg3200() {
mlimbird 8:c64f76d4deff 99 bytes bytes[6];
mlimbird 8:c64f76d4deff 100 memset(bytes,0,6);
mlimbird 8:c64f76d4deff 101
mlimbird 8:c64f76d4deff 102 i2c_read(ITG3200_ADDRESS, ITG3200_REGISTER_XMSB, 6, bytes);
mlimbird 8:c64f76d4deff 103 for (int i=0;i<3;++i) {
mlimbird 8:c64f76d4deff 104 gyro_data[i] = (int)bytes[2*i + 1] + (((int)bytes[2*i]) << 8);
mlimbird 8:c64f76d4deff 105 }
mlimbird 8:c64f76d4deff 106 }
mlimbird 8:c64f76d4deff 107
mlimbird 8:c64f76d4deff 108 void init_hmc5843() {
mlimbird 8:c64f76d4deff 109 bytes data = 0;
mlimbird 8:c64f76d4deff 110
mlimbird 8:c64f76d4deff 111 i2c_write(HMC5843_ADDRESS, HMC5843_REGISTER_MEASMODE, HMC5843_MEASMODE_CONT);
mlimbird 8:c64f76d4deff 112
mlimbird 8:c64f76d4deff 113 i2c_read(HMC5843_ADDRESS, HMC5843_REGISTER_MEASMODE, 1, &data);
mlimbird 8:c64f76d4deff 114 Serial.println((unsigned int)data);
mlimbird 8:c64f76d4deff 115 }
mlimbird 8:c64f76d4deff 116
mlimbird 8:c64f76d4deff 117 void read_hmc5843() {
mlimbird 8:c64f76d4deff 118 bytes bytes[6];
mlimbird 8:c64f76d4deff 119 memset(bytes,0,6);
mlimbird 8:c64f76d4deff 120
mlimbird 8:c64f76d4deff 121 i2c_read(HMC5843_ADDRESS, HMC5843_REGISTER_XMSB, 6, bytes);
mlimbird 8:c64f76d4deff 122
mlimbird 8:c64f76d4deff 123 for (int i=0;i<3;++i) {
mlimbird 8:c64f76d4deff 124 magnetometer_data[i] = (int)bytes[2*i + 1] + (((int)bytes[2*i]) << 8);
mlimbird 8:c64f76d4deff 125 }
mlimbird 8:c64f76d4deff 126 }
mlimbird 8:c64f76d4deff 127 */