3-Axio Digital Gyro

Dependencies:   ITG3200 WebSocketClient WiflyInterface mbed

Committer:
mbedschool
Date:
Fri Feb 06 04:55:02 2015 +0000
Revision:
0:f9e7b38b17ff
gyro

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbedschool 0:f9e7b38b17ff 1 #include "mbed.h"
mbedschool 0:f9e7b38b17ff 2 #include "WiflyInterface.h"
mbedschool 0:f9e7b38b17ff 3 #include "Websocket.h"
mbedschool 0:f9e7b38b17ff 4 #include "ITG3200.h"
mbedschool 0:f9e7b38b17ff 5
mbedschool 0:f9e7b38b17ff 6
mbedschool 0:f9e7b38b17ff 7 /* wifly interface:
mbedschool 0:f9e7b38b17ff 8 * - p9 and p10 are for the serial communication
mbedschool 0:f9e7b38b17ff 9 * - p19 is for the reset pin
mbedschool 0:f9e7b38b17ff 10 * - p26 is for the connection status
mbedschool 0:f9e7b38b17ff 11 * - "mbed" is the ssid of the network
mbedschool 0:f9e7b38b17ff 12 * - "password" is the password
mbedschool 0:f9e7b38b17ff 13 * - WPA is the security
mbedschool 0:f9e7b38b17ff 14 */
mbedschool 0:f9e7b38b17ff 15 WiflyInterface wifly(p13, p14, p19, p26, "WWNet", "mmmmmmmm", WPA);
mbedschool 0:f9e7b38b17ff 16 DigitalOut led1(LED1);
mbedschool 0:f9e7b38b17ff 17 ITG3200 gyro(p9, p10, 0x68);
mbedschool 0:f9e7b38b17ff 18
mbedschool 0:f9e7b38b17ff 19
mbedschool 0:f9e7b38b17ff 20
mbedschool 0:f9e7b38b17ff 21 int main() {
mbedschool 0:f9e7b38b17ff 22 wifly.init(); //Use DHCP
mbedschool 0:f9e7b38b17ff 23 //wifly.init("192.168.21.33","255.255.255.0","192.168.21.2");
mbedschool 0:f9e7b38b17ff 24 while (!wifly.connect());
mbedschool 0:f9e7b38b17ff 25 led1=1;
mbedschool 0:f9e7b38b17ff 26 printf("IP Address is %s\n\r", wifly.getIPAddress());
mbedschool 0:f9e7b38b17ff 27
mbedschool 0:f9e7b38b17ff 28 Websocket ws("ws://sockets.mbed.org/ws/mbedschool/viewer");
mbedschool 0:f9e7b38b17ff 29 //Websocket ws("ws://192.168.199.159:8888");
mbedschool 0:f9e7b38b17ff 30 while (!ws.connect());
mbedschool 0:f9e7b38b17ff 31 led1=2;
mbedschool 0:f9e7b38b17ff 32
mbedschool 0:f9e7b38b17ff 33
mbedschool 0:f9e7b38b17ff 34 int x = 0, y = 0, z = 0, temp = 0;
mbedschool 0:f9e7b38b17ff 35 //Set highest bandwidth.
mbedschool 0:f9e7b38b17ff 36 gyro.setLpBandwidth(LPFBW_42HZ);
mbedschool 0:f9e7b38b17ff 37
mbedschool 0:f9e7b38b17ff 38 while (1) {
mbedschool 0:f9e7b38b17ff 39 char data[256];
mbedschool 0:f9e7b38b17ff 40 wait(0.1f);
mbedschool 0:f9e7b38b17ff 41 x = gyro.getGyroX();
mbedschool 0:f9e7b38b17ff 42 y = gyro.getGyroY();
mbedschool 0:f9e7b38b17ff 43 z = gyro.getGyroZ();
mbedschool 0:f9e7b38b17ff 44 temp = gyro.getTemperature();
mbedschool 0:f9e7b38b17ff 45
mbedschool 0:f9e7b38b17ff 46 printf("Temp: %d, X: %d, Y: %d, Z: %d\n", temp, x, y, z);
mbedschool 0:f9e7b38b17ff 47 sprintf( data , "Temp: %d, X: %d, Y: %d, Z: %d\n", temp, x, y, z );
mbedschool 0:f9e7b38b17ff 48 ws.send(data);
mbedschool 0:f9e7b38b17ff 49
mbedschool 0:f9e7b38b17ff 50 //wait(1.0);
mbedschool 0:f9e7b38b17ff 51 }
mbedschool 0:f9e7b38b17ff 52 }