Joystick for SLVM

Dependencies:   mbed

Committer:
jnagendran3
Date:
Tue Dec 09 01:23:36 2014 +0000
Revision:
0:636b2ff1fa0b
first

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jnagendran3 0:636b2ff1fa0b 1 /* Copyright (c) 2012 Tristan Hughes, MIT License
jnagendran3 0:636b2ff1fa0b 2 *
jnagendran3 0:636b2ff1fa0b 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
jnagendran3 0:636b2ff1fa0b 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
jnagendran3 0:636b2ff1fa0b 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
jnagendran3 0:636b2ff1fa0b 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
jnagendran3 0:636b2ff1fa0b 7 * furnished to do so, subject to the following conditions:
jnagendran3 0:636b2ff1fa0b 8 *
jnagendran3 0:636b2ff1fa0b 9 * The above copyright notice and this permission notice shall be included in all copies or
jnagendran3 0:636b2ff1fa0b 10 * substantial portions of the Software.
jnagendran3 0:636b2ff1fa0b 11 *
jnagendran3 0:636b2ff1fa0b 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
jnagendran3 0:636b2ff1fa0b 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
jnagendran3 0:636b2ff1fa0b 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
jnagendran3 0:636b2ff1fa0b 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
jnagendran3 0:636b2ff1fa0b 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
jnagendran3 0:636b2ff1fa0b 17 */
jnagendran3 0:636b2ff1fa0b 18
jnagendran3 0:636b2ff1fa0b 19 #include "xbee.h"
jnagendran3 0:636b2ff1fa0b 20
jnagendran3 0:636b2ff1fa0b 21
jnagendran3 0:636b2ff1fa0b 22 xbee::xbee(PinName tx, PinName rx, PinName reset)
jnagendran3 0:636b2ff1fa0b 23 {
jnagendran3 0:636b2ff1fa0b 24 _tx = tx;
jnagendran3 0:636b2ff1fa0b 25 _rx = rx;
jnagendran3 0:636b2ff1fa0b 26 _reset = reset;
jnagendran3 0:636b2ff1fa0b 27 }
jnagendran3 0:636b2ff1fa0b 28
jnagendran3 0:636b2ff1fa0b 29 xbee::~xbee()
jnagendran3 0:636b2ff1fa0b 30 {
jnagendran3 0:636b2ff1fa0b 31 }
jnagendran3 0:636b2ff1fa0b 32
jnagendran3 0:636b2ff1fa0b 33 int xbee::ConfigMode()
jnagendran3 0:636b2ff1fa0b 34 {
jnagendran3 0:636b2ff1fa0b 35 int a;
jnagendran3 0:636b2ff1fa0b 36 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 37 wait(2);
jnagendran3 0:636b2ff1fa0b 38 DATA.printf("+++");
jnagendran3 0:636b2ff1fa0b 39 while (a != 75) {
jnagendran3 0:636b2ff1fa0b 40 if (DATA.readable()) {
jnagendran3 0:636b2ff1fa0b 41 a = DATA.getc();
jnagendran3 0:636b2ff1fa0b 42 }
jnagendran3 0:636b2ff1fa0b 43 }
jnagendran3 0:636b2ff1fa0b 44 wait(1);
jnagendran3 0:636b2ff1fa0b 45 printf("config mode\n");
jnagendran3 0:636b2ff1fa0b 46 return 1;
jnagendran3 0:636b2ff1fa0b 47 }
jnagendran3 0:636b2ff1fa0b 48
jnagendran3 0:636b2ff1fa0b 49 int xbee::GetSerial(int *serial_no)
jnagendran3 0:636b2ff1fa0b 50 {
jnagendran3 0:636b2ff1fa0b 51 int sh1,sh2,sh3,sl1,sl2,sl3,sl4;
jnagendran3 0:636b2ff1fa0b 52 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 53 wait_ms(50);
jnagendran3 0:636b2ff1fa0b 54 DATA.printf("ATSL \r");
jnagendran3 0:636b2ff1fa0b 55 DATA.scanf ("%2x%2x%2x%2x",&sl1,&sl2,&sl3,&sl4);
jnagendran3 0:636b2ff1fa0b 56 wait_ms(500);
jnagendran3 0:636b2ff1fa0b 57 DATA.printf("ATSH \r");
jnagendran3 0:636b2ff1fa0b 58 DATA.scanf ("%2x%2x%2x",&sh1,&sh2,&sh3);
jnagendran3 0:636b2ff1fa0b 59
jnagendran3 0:636b2ff1fa0b 60 serial_no[0] = sh1;
jnagendran3 0:636b2ff1fa0b 61 serial_no[1] = sh2;
jnagendran3 0:636b2ff1fa0b 62 serial_no[2] = sh3;
jnagendran3 0:636b2ff1fa0b 63 serial_no[3] = sl1;
jnagendran3 0:636b2ff1fa0b 64 serial_no[4] = sl2;
jnagendran3 0:636b2ff1fa0b 65 serial_no[5] = sl3;
jnagendran3 0:636b2ff1fa0b 66 serial_no[6] = sl4;
jnagendran3 0:636b2ff1fa0b 67
jnagendran3 0:636b2ff1fa0b 68 return 1;
jnagendran3 0:636b2ff1fa0b 69 }
jnagendran3 0:636b2ff1fa0b 70
jnagendran3 0:636b2ff1fa0b 71 int xbee::SetKey(int* key)
jnagendran3 0:636b2ff1fa0b 72 {
jnagendran3 0:636b2ff1fa0b 73 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 74 DATA.printf("ATEE 1 \r");
jnagendran3 0:636b2ff1fa0b 75
jnagendran3 0:636b2ff1fa0b 76 DATA.scanf ("%*s");
jnagendran3 0:636b2ff1fa0b 77 wait_ms(1);
jnagendran3 0:636b2ff1fa0b 78 DATA.printf("ATKY %x \r",key);
jnagendran3 0:636b2ff1fa0b 79 DATA.scanf ("%*s");
jnagendran3 0:636b2ff1fa0b 80 return 1;
jnagendran3 0:636b2ff1fa0b 81 }
jnagendran3 0:636b2ff1fa0b 82
jnagendran3 0:636b2ff1fa0b 83 int xbee::WriteSettings()
jnagendran3 0:636b2ff1fa0b 84 {
jnagendran3 0:636b2ff1fa0b 85 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 86 wait_ms(5);
jnagendran3 0:636b2ff1fa0b 87 DATA.printf("ATWR \r");
jnagendran3 0:636b2ff1fa0b 88 DATA.scanf ("%*s");
jnagendran3 0:636b2ff1fa0b 89 return 1;
jnagendran3 0:636b2ff1fa0b 90 }
jnagendran3 0:636b2ff1fa0b 91
jnagendran3 0:636b2ff1fa0b 92 int xbee::ExitConfigMode()
jnagendran3 0:636b2ff1fa0b 93 {
jnagendran3 0:636b2ff1fa0b 94 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 95 wait_ms(5);
jnagendran3 0:636b2ff1fa0b 96 DATA.printf("ATCN \r");
jnagendran3 0:636b2ff1fa0b 97 DATA.scanf ("%*s");
jnagendran3 0:636b2ff1fa0b 98 return 1;
jnagendran3 0:636b2ff1fa0b 99 }
jnagendran3 0:636b2ff1fa0b 100
jnagendran3 0:636b2ff1fa0b 101 int xbee::SendData(char *data_buf)
jnagendran3 0:636b2ff1fa0b 102 {
jnagendran3 0:636b2ff1fa0b 103 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 104 DATA.printf("%s",data_buf);
jnagendran3 0:636b2ff1fa0b 105 return 1;
jnagendran3 0:636b2ff1fa0b 106 }
jnagendran3 0:636b2ff1fa0b 107
jnagendran3 0:636b2ff1fa0b 108 void xbee::RecieveData(char *data_buf, int numchar)
jnagendran3 0:636b2ff1fa0b 109 {
jnagendran3 0:636b2ff1fa0b 110 int count=0;
jnagendran3 0:636b2ff1fa0b 111 if(numchar == 0) {
jnagendran3 0:636b2ff1fa0b 112 numchar = sizeof(data_buf);
jnagendran3 0:636b2ff1fa0b 113 }
jnagendran3 0:636b2ff1fa0b 114 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 115 while(numchar!=count) {
jnagendran3 0:636b2ff1fa0b 116 if(DATA.readable()) {
jnagendran3 0:636b2ff1fa0b 117 *data_buf = DATA.getc();
jnagendran3 0:636b2ff1fa0b 118 data_buf+=1;
jnagendran3 0:636b2ff1fa0b 119 count++;
jnagendran3 0:636b2ff1fa0b 120 }
jnagendran3 0:636b2ff1fa0b 121
jnagendran3 0:636b2ff1fa0b 122 }
jnagendran3 0:636b2ff1fa0b 123 }
jnagendran3 0:636b2ff1fa0b 124
jnagendran3 0:636b2ff1fa0b 125 int xbee::SetPanId(int pan_id)
jnagendran3 0:636b2ff1fa0b 126 {
jnagendran3 0:636b2ff1fa0b 127 Serial DATA(_tx,_rx);
jnagendran3 0:636b2ff1fa0b 128 wait_ms(5);
jnagendran3 0:636b2ff1fa0b 129 DATA.printf("ATID %i\r",pan_id);
jnagendran3 0:636b2ff1fa0b 130 DATA.scanf ("%*s");
jnagendran3 0:636b2ff1fa0b 131 return 1;
jnagendran3 0:636b2ff1fa0b 132 }
jnagendran3 0:636b2ff1fa0b 133
jnagendran3 0:636b2ff1fa0b 134 void xbee::Reset()
jnagendran3 0:636b2ff1fa0b 135 {
jnagendran3 0:636b2ff1fa0b 136 DigitalOut rssi(_reset);
jnagendran3 0:636b2ff1fa0b 137 rssi = 0;
jnagendran3 0:636b2ff1fa0b 138 wait_ms(10);
jnagendran3 0:636b2ff1fa0b 139 rssi = 1;
jnagendran3 0:636b2ff1fa0b 140 wait_ms(1);
jnagendran3 0:636b2ff1fa0b 141 }
jnagendran3 0:636b2ff1fa0b 142
jnagendran3 0:636b2ff1fa0b 143
jnagendran3 0:636b2ff1fa0b 144