Yujing Qian / Mbed 2 deprecated 202Ahm1

2014_winter_EE202A_HM1_UCLA Author:Yujing Qian and Tianlei Tang

Dependencies:   MAG3110 MMA8451Q TSI mbed

main.cpp@1:58c266799ba7, 2014-02-14 (annotated)

Committer:
allonq
Date:
Fri Feb 14 21:04:08 2014 +0000
Revision:
1:58c266799ba7
Parent:
0:3cc7f3653a5d 
EE202Ahm1_maindevice

Who changed what in which revision?

UserRevisionLine numberNew contents of line
allonq 1:58c266799ba7 1 /* This is a mbed program for EE202A, hm1. written by Yujing Qian's team
allonq 1:58c266799ba7 2 Main idea:
allonq 1:58c266799ba7 3 Use interrupt to change the default configuration of the device and choose different channels and different sampling rate.
allonq 1:58c266799ba7 4 The corresponding GUI is host_command.py
allonq 1:58c266799ba7 5 All the commented-out code is for debugging use, please ignore them
allonq 1:58c266799ba7 6 Author: Yujing Qian, Tianlei Tang Feb.12/2014
allonq 1:58c266799ba7 7 */
allonq 0:3cc7f3653a5d 8 #include "mbed.h"
allonq 0:3cc7f3653a5d 9 #include "MMA8451Q.h"
allonq 0:3cc7f3653a5d 10 #include "MAG3110.h"
allonq 0:3cc7f3653a5d 11 #include "TSISensor.h"
allonq 0:3cc7f3653a5d 12 #define MMA8451_I2C_ADDRESS (0x1d<<1)
allonq 0:3cc7f3653a5d 13 #define BUFFER_SIZE 200
allonq 0:3cc7f3653a5d 14 #define BAUDRATE 9600
allonq 0:3cc7f3653a5d 15
allonq 0:3cc7f3653a5d 16 AnalogIn lightsensor(PTE22);
allonq 0:3cc7f3653a5d 17 AnalogIn analoginput(PTB0);
allonq 0:3cc7f3653a5d 18 Serial pc(USBTX,USBRX);
allonq 0:3cc7f3653a5d 19 char rx_buffer[BUFFER_SIZE];
allonq 0:3cc7f3653a5d 20 int buff=0;
allonq 0:3cc7f3653a5d 21 bool received;
allonq 1:58c266799ba7 22 Timer timer;
allonq 0:3cc7f3653a5d 23
allonq 0:3cc7f3653a5d 24 void receive_handler(){
allonq 0:3cc7f3653a5d 25 while (pc.readable() && buff< BUFFER_SIZE){
allonq 0:3cc7f3653a5d 26
allonq 0:3cc7f3653a5d 27 rx_buffer[buff] = pc.getc();
allonq 0:3cc7f3653a5d 28 //pc.printf(& rx_buffer[buff]);
allonq 0:3cc7f3653a5d 29 if (rx_buffer[buff] == '#'){
allonq 0:3cc7f3653a5d 30 rx_buffer[buff] = '\0';
allonq 0:3cc7f3653a5d 31 /*
allonq 1:58c266799ba7 32 rx_buffer[14] = '\0';
allonq 1:58c266799ba7 33 int tag=1;
allonq 0:3cc7f3653a5d 34 char *testx=(char*)&tag;
allonq 0:3cc7f3653a5d 35 buff=14;
allonq 0:3cc7f3653a5d 36 rx_buffer[0]=(*testx);
allonq 1:58c266799ba7 37 tag=3;
allonq 0:3cc7f3653a5d 38 testx=(char*)&tag;
allonq 0:3cc7f3653a5d 39 rx_buffer[1]=(*testx);
allonq 0:3cc7f3653a5d 40 rx_buffer[2]=0;
allonq 0:3cc7f3653a5d 41 rx_buffer[3]=0;
allonq 0:3cc7f3653a5d 42 rx_buffer[4]=0;
allonq 0:3cc7f3653a5d 43 tag=100;
allonq 0:3cc7f3653a5d 44 testx=(char*)&tag;
allonq 0:3cc7f3653a5d 45 rx_buffer[5]=(*testx);
allonq 0:3cc7f3653a5d 46 rx_buffer[6]=0;
allonq 0:3cc7f3653a5d 47 rx_buffer[7]=0;
allonq 0:3cc7f3653a5d 48 rx_buffer[8]=0;
allonq 1:58c266799ba7 49 tag=100;
allonq 0:3cc7f3653a5d 50 testx=(char*)&(tag);
allonq 0:3cc7f3653a5d 51 rx_buffer[9]=(*testx);
allonq 0:3cc7f3653a5d 52 rx_buffer[10]=0;
allonq 0:3cc7f3653a5d 53 rx_buffer[11]=0;
allonq 0:3cc7f3653a5d 54 rx_buffer[12]=0;
allonq 1:58c266799ba7 55 tag=100;
allonq 0:3cc7f3653a5d 56 testx=(char*)&(tag);
allonq 0:3cc7f3653a5d 57 rx_buffer[13]=(*testx);
allonq 0:3cc7f3653a5d 58 */
allonq 0:3cc7f3653a5d 59 //pc.printf(rx_buffer);pc.printf("\n");
allonq 0:3cc7f3653a5d 60 //pc.printf("testmode_loaded\n");
allonq 0:3cc7f3653a5d 61 received = true;
allonq 0:3cc7f3653a5d 62 //pc.printf("received=%d\n",received);
allonq 0:3cc7f3653a5d 63 break;
allonq 0:3cc7f3653a5d 64 }
allonq 0:3cc7f3653a5d 65 buff++;
allonq 0:3cc7f3653a5d 66 }
allonq 0:3cc7f3653a5d 67 return;
allonq 0:3cc7f3653a5d 68 }
allonq 0:3cc7f3653a5d 69
allonq 0:3cc7f3653a5d 70 int main() {
allonq 0:3cc7f3653a5d 71 buff = 0;
allonq 0:3cc7f3653a5d 72 received=false;
allonq 0:3cc7f3653a5d 73 pc.baud(BAUDRATE);
allonq 0:3cc7f3653a5d 74 //pc.printf("hello to the magic world\n");
allonq 0:3cc7f3653a5d 75 //pc.printf("minimumnum=%f\n",1.0/BAUDRATE);
allonq 0:3cc7f3653a5d 76
allonq 0:3cc7f3653a5d 77 //set interrupt
allonq 0:3cc7f3653a5d 78 MMA8451Q acc(PTE25, PTE24, MMA8451_I2C_ADDRESS);
allonq 0:3cc7f3653a5d 79 MAG3110 mag(PTE25, PTE24);
allonq 0:3cc7f3653a5d 80 TSISensor tsi;
allonq 0:3cc7f3653a5d 81 //int aaattt=0;
allonq 0:3cc7f3653a5d 82 int accx,accy,accz;
allonq 0:3cc7f3653a5d 83 int magx,magy,magz;
allonq 0:3cc7f3653a5d 84 int light;
allonq 0:3cc7f3653a5d 85 int tsiPerc;
allonq 0:3cc7f3653a5d 86 int tsiDis;
allonq 0:3cc7f3653a5d 87 int analogin;
allonq 0:3cc7f3653a5d 88 char* select;
allonq 1:58c266799ba7 89 int enable=32767;
allonq 0:3cc7f3653a5d 90 int tmpf=0;
allonq 0:3cc7f3653a5d 91 int i,j;
allonq 1:58c266799ba7 92 int interval[15];
allonq 0:3cc7f3653a5d 93 int count[15];
allonq 1:58c266799ba7 94 int tmptime;
allonq 1:58c266799ba7 95 for(i=0;i<15;i++)interval[i]=1000;//default:1ms
allonq 0:3cc7f3653a5d 96 for(i=0;i<15;i++)count[i]=0;
allonq 0:3cc7f3653a5d 97 bool output_en=0;
allonq 0:3cc7f3653a5d 98 char *tmp;
allonq 0:3cc7f3653a5d 99 //int fl2in;
allonq 0:3cc7f3653a5d 100 char* output;
allonq 0:3cc7f3653a5d 101 output=new char;
allonq 0:3cc7f3653a5d 102 pc.attach(&receive_handler,Serial::RxIrq);
allonq 0:3cc7f3653a5d 103 //pc.printf("enable=%d",enable);
allonq 1:58c266799ba7 104 timer.start();
allonq 1:58c266799ba7 105 tmptime=timer.read_us();
allonq 1:58c266799ba7 106 for(i=0;i<15;i++)count[i]=tmptime;
allonq 1:58c266799ba7 107 //pc.printf("time_written");
allonq 1:58c266799ba7 108
allonq 0:3cc7f3653a5d 109 while (true) {
allonq 0:3cc7f3653a5d 110 if (received) {
allonq 0:3cc7f3653a5d 111 select=rx_buffer;
allonq 0:3cc7f3653a5d 112 //pc.printf("command=");
allonq 0:3cc7f3653a5d 113 //pc.printf(select);
allonq 0:3cc7f3653a5d 114 //pc.printf("\n");
allonq 0:3cc7f3653a5d 115 enable=0;
allonq 0:3cc7f3653a5d 116 enable=(int)(select[1]<<8)+(int)select[0];//record the command
allonq 0:3cc7f3653a5d 117
allonq 0:3cc7f3653a5d 118 i=2;
allonq 0:3cc7f3653a5d 119 int k=15;//indicate which channel
allonq 0:3cc7f3653a5d 120 while(i<buff){
allonq 0:3cc7f3653a5d 121 tmpf=0;
allonq 0:3cc7f3653a5d 122 for( j=0;j<4;j++){
allonq 0:3cc7f3653a5d 123 tmpf=(tmpf<<8)|select[i+j];
allonq 0:3cc7f3653a5d 124 }
allonq 0:3cc7f3653a5d 125 while(!((enable>>(15-k))&1)){
allonq 0:3cc7f3653a5d 126 k=k-1;
allonq 0:3cc7f3653a5d 127 }
allonq 0:3cc7f3653a5d 128 k=k-1;
allonq 0:3cc7f3653a5d 129
allonq 1:58c266799ba7 130 interval[14-k]=1000000/tmpf;//interval us per sample
allonq 0:3cc7f3653a5d 131 i=i+4;
allonq 0:3cc7f3653a5d 132 }
allonq 1:58c266799ba7 133 //for (i=0;i<15;i++)count[i]=0;
allonq 0:3cc7f3653a5d 134
allonq 1:58c266799ba7 135 //for(int o=0;o<15;o++){pc.printf("count=%d",count[o]);pc.printf("interval=%d\n",interval[o]);}
allonq 0:3cc7f3653a5d 136 //pc.printf("enable=%d\n",enable&1);
allonq 0:3cc7f3653a5d 137 //pc.putc('$');pc.putc('c');pc.putc('d');pc.putc('_');pc.putc('r');pc.putc('v');pc.putc('d');
allonq 0:3cc7f3653a5d 138 buff=0;
allonq 1:58c266799ba7 139 tmptime=timer.read_us();
allonq 1:58c266799ba7 140 for(i=0;i<15;i++)count[i]=tmptime;
allonq 1:58c266799ba7 141 received=false;
allonq 1:58c266799ba7 142 //pc.printf("command,received\n");
allonq 0:3cc7f3653a5d 143 }
allonq 0:3cc7f3653a5d 144 int output_map=0;
allonq 0:3cc7f3653a5d 145 output_en=false;
allonq 1:58c266799ba7 146
allonq 0:3cc7f3653a5d 147
allonq 1:58c266799ba7 148
allonq 0:3cc7f3653a5d 149 int opt=0;
allonq 0:3cc7f3653a5d 150 //pc.printf("nscanning\n");
allonq 1:58c266799ba7 151 //for(int o=0;o<15;o++){pc.printf("count=%d",count[o]);pc.printf("interval=%d\n",interval[o]);}
allonq 0:3cc7f3653a5d 152 //pc.getc();
allonq 1:58c266799ba7 153 if((enable&(1))&&(timer.read_us()>=(count[0]+interval[0]))){
allonq 1:58c266799ba7 154 count[0]=timer.read_us();
allonq 0:3cc7f3653a5d 155 output_map=output_map|(1);
allonq 0:3cc7f3653a5d 156 output_en=true;//output
allonq 0:3cc7f3653a5d 157 light=(int)(lightsensor.read()*10000);
allonq 0:3cc7f3653a5d 158 tmp=(char*)&light;//pc.printf("opt=%d",opt);
allonq 0:3cc7f3653a5d 159 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 160 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 161 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 162 output[opt+3]=(*tmp);
allonq 1:58c266799ba7 163
allonq 0:3cc7f3653a5d 164 opt=opt+4; }
allonq 1:58c266799ba7 165 //else count[0]++;
allonq 0:3cc7f3653a5d 166
allonq 0:3cc7f3653a5d 167 //light sensor
allonq 1:58c266799ba7 168 if((enable&(1<<1))&&(timer.read_us()>=(count[1]+interval[1]))){
allonq 1:58c266799ba7 169 count[1]=timer.read_us();
allonq 0:3cc7f3653a5d 170 output_map=output_map|(1<<1);
allonq 0:3cc7f3653a5d 171 output_en=true;//output
allonq 0:3cc7f3653a5d 172 accx=(int)(acc.getAccX()*10000);
allonq 0:3cc7f3653a5d 173 tmp=(char*)&accx;//pc.printf("opt=%d",opt);
allonq 0:3cc7f3653a5d 174 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 175 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 176 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 177 output[opt+3]=(*tmp);
allonq 0:3cc7f3653a5d 178 opt=opt+4;}
allonq 1:58c266799ba7 179 //else count[1]++;
allonq 0:3cc7f3653a5d 180 //accx
allonq 0:3cc7f3653a5d 181
allonq 1:58c266799ba7 182 if((enable&(1<<2))&&(timer.read_us()>=(count[2]+interval[2]))){
allonq 1:58c266799ba7 183 count[2]=timer.read_us();
allonq 0:3cc7f3653a5d 184 output_map=output_map|(1<<2);
allonq 0:3cc7f3653a5d 185 output_en=true;//output
allonq 0:3cc7f3653a5d 186 accy=(int)(acc.getAccY()*10000);
allonq 0:3cc7f3653a5d 187 tmp=(char*)&accy;//pc.printf("opt=%d",opt);
allonq 0:3cc7f3653a5d 188 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 189 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 190 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 191 output[opt+3]=(*tmp);
allonq 1:58c266799ba7 192
allonq 0:3cc7f3653a5d 193 opt=opt+4;}
allonq 1:58c266799ba7 194 // else count[2]++;
allonq 0:3cc7f3653a5d 195 //accy
allonq 1:58c266799ba7 196 if((enable&(1<<3))&&(timer.read_us()>=(count[3]+interval[3]))){
allonq 1:58c266799ba7 197 count[3]=timer.read_us();
allonq 0:3cc7f3653a5d 198 output_map=output_map|(1<<3);
allonq 0:3cc7f3653a5d 199 output_en=true;//output
allonq 0:3cc7f3653a5d 200 accz=(int)(acc.getAccZ()*10000);
allonq 0:3cc7f3653a5d 201 tmp=(char*)&accz;//pc.printf("grav=%float",accz);
allonq 0:3cc7f3653a5d 202 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 203 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 204 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 205 output[opt+3]=(*tmp);
allonq 0:3cc7f3653a5d 206 opt=opt+4;}
allonq 1:58c266799ba7 207 //else count[3]++;
allonq 0:3cc7f3653a5d 208 //accz
allonq 1:58c266799ba7 209 if((enable&(1<<4))&&(timer.read_us()>=(count[4]+interval[4]))){
allonq 1:58c266799ba7 210 count[4]=timer.read_us();
allonq 0:3cc7f3653a5d 211 output_map=output_map|(1<<4);
allonq 0:3cc7f3653a5d 212 output_en=true;//output
allonq 0:3cc7f3653a5d 213 magx=(int)(mag.getX()*10000);
allonq 0:3cc7f3653a5d 214 tmp=(char*)&magx;//pc.printf("opt=%d",opt);
allonq 0:3cc7f3653a5d 215 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 216 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 217 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 218 output[opt+3]=(*tmp);
allonq 1:58c266799ba7 219 //count[4]=1;
allonq 0:3cc7f3653a5d 220 opt=opt+4;}
allonq 1:58c266799ba7 221 // else count[4]++;
allonq 0:3cc7f3653a5d 222 //magx
allonq 1:58c266799ba7 223 if((enable&(1<<5))&&(timer.read_us()>=(count[5]+interval[5]))){
allonq 1:58c266799ba7 224 count[5]=timer.read_us();
allonq 0:3cc7f3653a5d 225 output_map=output_map|(1<<5);
allonq 0:3cc7f3653a5d 226 output_en=true;//output
allonq 0:3cc7f3653a5d 227 magy=(int)(mag.getY()*10000);
allonq 0:3cc7f3653a5d 228 tmp=(char*)&magy;//pc.printf("opt=%d",opt);
allonq 0:3cc7f3653a5d 229 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 230 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 231 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 232 output[opt+3]=(*tmp);
allonq 1:58c266799ba7 233 //count[5]=1;
allonq 0:3cc7f3653a5d 234 opt=opt+4;}
allonq 1:58c266799ba7 235 //else count[5]++;
allonq 0:3cc7f3653a5d 236 //magy
allonq 1:58c266799ba7 237 if((enable&(1<<6))&&(timer.read_us()>=(count[6]+interval[6]))){
allonq 1:58c266799ba7 238 count[6]=timer.read_us();
allonq 0:3cc7f3653a5d 239 output_map=output_map|(1<<6);
allonq 0:3cc7f3653a5d 240 magz=(int)(mag.getZ()*10000);
allonq 0:3cc7f3653a5d 241 output_en=true;//output
allonq 0:3cc7f3653a5d 242 tmp=(char*)&magz;//pc.printf("7");
allonq 0:3cc7f3653a5d 243 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 244 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 245 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 246 output[opt+3]=(*tmp);
allonq 0:3cc7f3653a5d 247 opt=opt+4;}
allonq 1:58c266799ba7 248 //else count[6]++;
allonq 0:3cc7f3653a5d 249 //magz
allonq 1:58c266799ba7 250 if((enable&(1<<7))&&(timer.read_us()>=(count[7]+interval[7]))){
allonq 1:58c266799ba7 251 count[7]=timer.read_us();
allonq 0:3cc7f3653a5d 252 output_map=output_map|(1<<7);
allonq 0:3cc7f3653a5d 253 tsiPerc=(int)(tsi.readPercentage()*10000);
allonq 0:3cc7f3653a5d 254 output_en=true;//output
allonq 0:3cc7f3653a5d 255 tmp=(char*)&tsiPerc;//pc.printf("7");
allonq 0:3cc7f3653a5d 256 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 257 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 258 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 259 output[opt+3]=(*tmp);
allonq 1:58c266799ba7 260 //count[7]=1;
allonq 0:3cc7f3653a5d 261 opt=opt+4;}
allonq 1:58c266799ba7 262 //else count[7]++;
allonq 0:3cc7f3653a5d 263 //TIS_perc
allonq 1:58c266799ba7 264 if((enable&(1<<8))&&(timer.read_us()>=(count[8]+interval[8]))){
allonq 1:58c266799ba7 265 count[8]=timer.read_us();
allonq 0:3cc7f3653a5d 266 output_map=output_map|(1<<8);
allonq 0:3cc7f3653a5d 267 tsiDis=(int)(tsi.readDistance()*10000);
allonq 0:3cc7f3653a5d 268 output_en=true;//output
allonq 0:3cc7f3653a5d 269 tmp=(char*)&tsiDis;//pc.printf("8");
allonq 0:3cc7f3653a5d 270 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 271 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 272 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 273 output[opt+3]=(*tmp);
allonq 1:58c266799ba7 274 //count[8]=1;
allonq 0:3cc7f3653a5d 275 opt=opt+4;}
allonq 1:58c266799ba7 276 //else count[8]++;
allonq 0:3cc7f3653a5d 277 //TIS_perc
allonq 0:3cc7f3653a5d 278 //touchs1=touch1.read();
allonq 0:3cc7f3653a5d 279 //touchs2=touch2.read();
allonq 0:3cc7f3653a5d 280
allonq 1:58c266799ba7 281 if((enable&(1<<9))&&(timer.read_us()>=(count[9]+interval[9]))){
allonq 1:58c266799ba7 282 count[9]=timer.read_us();
allonq 0:3cc7f3653a5d 283 output_map=output_map|(1<<9);
allonq 0:3cc7f3653a5d 284 analogin=(int)(analoginput.read()*10000);
allonq 0:3cc7f3653a5d 285 output_en=true;//output
allonq 0:3cc7f3653a5d 286 tmp=(char*)&analogin;//pc.printf("opt=%d",opt);
allonq 0:3cc7f3653a5d 287 output[opt]=(*(tmp+3));
allonq 0:3cc7f3653a5d 288 output[opt+1]=(*(tmp+2));
allonq 0:3cc7f3653a5d 289 output[opt+2]=(*(tmp+1));
allonq 0:3cc7f3653a5d 290 output[opt+3]=(*tmp);
allonq 1:58c266799ba7 291 //count[9]=1;
allonq 0:3cc7f3653a5d 292 opt=opt+4;}
allonq 1:58c266799ba7 293 //else count[9]++;
allonq 0:3cc7f3653a5d 294
allonq 0:3cc7f3653a5d 295
allonq 0:3cc7f3653a5d 296 //analog channel 1#
allonq 0:3cc7f3653a5d 297 //----------OUTPUT----------
allonq 0:3cc7f3653a5d 298 if(output_en){
allonq 0:3cc7f3653a5d 299 //aaattt++;
allonq 0:3cc7f3653a5d 300 //if(aaattt==960){pc.printf("get960");aaattt=1;}
allonq 0:3cc7f3653a5d 301 //pc.printf("ok\n");
allonq 0:3cc7f3653a5d 302 //pc.printf("map=%d",output_map);
allonq 0:3cc7f3653a5d 303 pc.putc('#');//begin of a data
allonq 0:3cc7f3653a5d 304 //for(int o=0;o<15;o++)pc.printf("a=%d\n",output_map&(1<<o));
allonq 0:3cc7f3653a5d 305
allonq 0:3cc7f3653a5d 306 //pc.printf(output);
allonq 0:3cc7f3653a5d 307
allonq 0:3cc7f3653a5d 308 tmp=(char*)&output_map;
allonq 0:3cc7f3653a5d 309 pc.putc(*(tmp));
allonq 0:3cc7f3653a5d 310 pc.putc(*(tmp+1));
allonq 0:3cc7f3653a5d 311 for (int l=0;l<opt;l++) pc.putc(output[l]);
allonq 0:3cc7f3653a5d 312
allonq 0:3cc7f3653a5d 313 /*
allonq 0:3cc7f3653a5d 314 pc.printf("\n");
allonq 0:3cc7f3653a5d 315 pc.printf("c0=%d",count[0]);pc.printf("c1=%d",count[1]);pc.printf("c9=%d",count[9]);
allonq 1:58c266799ba7 316 pc.printf("time=%d\n",timer.read_us());
allonq 0:3cc7f3653a5d 317 pc.printf("translate=%d",(int)(*(tmp+1)));
allonq 0:3cc7f3653a5d 318 pc.printf("translate=%d",(int)(*(tmp)));
allonq 0:3cc7f3653a5d 319 pc.printf("\n");
allonq 0:3cc7f3653a5d 320 int inttmp;
allonq 0:3cc7f3653a5d 321 for (i=0;i<8;i++){
allonq 0:3cc7f3653a5d 322 inttmp=0;
allonq 0:3cc7f3653a5d 323 for(int k=0;k<4;k++){
allonq 0:3cc7f3653a5d 324 inttmp=(inttmp<<8);
allonq 0:3cc7f3653a5d 325 inttmp+=((int)(output[4*i+k]));
allonq 0:3cc7f3653a5d 326 }
allonq 0:3cc7f3653a5d 327 pc.printf("output=%d\n",inttmp);
allonq 0:3cc7f3653a5d 328 }
allonq 1:58c266799ba7 329
allonq 0:3cc7f3653a5d 330 */
allonq 0:3cc7f3653a5d 331
allonq 0:3cc7f3653a5d 332 //
allonq 0:3cc7f3653a5d 333 // pc.printf("finish\n");
allonq 0:3cc7f3653a5d 334 }
allonq 0:3cc7f3653a5d 335 //pc.printf("ck=%d",count[0]);
allonq 1:58c266799ba7 336 //wait_us(1000000/BAUDRATE);
allonq 0:3cc7f3653a5d 337 }
allonq 0:3cc7f3653a5d 338
allonq 0:3cc7f3653a5d 339 }