3-Axio Digital Gyro
Dependencies: ITG3200 WebSocketClient WiflyInterface mbed
main.cpp@0:f9e7b38b17ff, 2015-02-06 (annotated)
- Committer:
- mbedschool
- Date:
- Fri Feb 06 04:55:02 2015 +0000
- Revision:
- 0:f9e7b38b17ff
gyro
Who changed what in which revision?
User | Revision | Line number | New 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 | } |