void parse_ins_msg( void ) { while (InsLink(ChAvailable())) { uint8_t ch = InsLink(Getch()); if (CHIMU_Parse(ch, 0, &CHIMU_DATA)) { if(CHIMU_DATA.m_MsgID==0x03) { new_ins_attitude = 1; RunOnceEvery(25, LED_TOGGLE(3) ); if (CHIMU_DATA.m_attitude.euler.phi > M_PI) { CHIMU_DATA.m_attitude.euler.phi -= 2 * M_PI; } EstimatorSetAtt(CHIMU_DATA.m_attitude.euler.phi, CHIMU_DATA.m_attitude.euler.psi, CHIMU_DATA.m_attitude.euler.theta); EstimatorSetRate(CHIMU_DATA.m_sensor.rate[0],CHIMU_DATA.m_attrates.euler.theta); } else if(CHIMU_DATA.m_MsgID==0x02) { RunOnceEvery(25,DOWNLINK_SEND_AHRS_EULER(DefaultChannel, &CHIMU_DATA.m_sensor.rate[0], &CHIMU_DATA.m_sensor.rate[1], &CHIMU_DATA.m_sensor.rate[2])); } } } }
/************************************************************************* 主函数 **************************************************************************/ void main() { uchar key; Init_Com();//串口初始化 count=0; P0=0xbf; fmq=0; while(1) { P1=0x0f; if(P1!=0x0f) { delay(400); key=getkey(); Getch(key); delay(400); } xianshi(); } }
void main(void) { int seg, data; char c; unsigned e=0x9000,i=0; InitLib(); Print("\r\nPlease Input a value writting to segment 0x9000 of Flash Member: "); Scanf("%d", &seg); FlashErase(e); while(i<65535) { FlashWrite(e, i, seg); Print("\r\nThe value %d is writting to offset %d of Flash Memory", seg, i); i++; seg++; if(i%100==0) { Print("\r\nPress q to quit or any key to continue..."); c=Getch(); if ((c=='q') || (c=='Q')) return; } } }
/*------------------------------------------------------*/ void AuxRTCM (void) { char c; while(Kbhit(CHAUX)) { if(!AuxBuff) Auxp=AuxBuff=memalloc(LINK_LEN); switch(c=Getch(CHAUX)) { case 0x0A: case 0x0D: *Auxp=null; Auxp=AuxBuff; if(RTCMDec(Auxp)) if(dGPS) { SendDGPS(0); SendDGPS(LinkAddr(OBP)); } break; default: if(Auxp != &AuxBuff[LINK_LEN-1]) *Auxp++=c; else *Auxp=c; break; } } }
void xsens_event_task( void ) { while (Xsens1Link(ChAvailable()) && !xsens_msg_received[0]) { parse_xsens_msg(0, Xsens1Link(Getch())); } /* while (Xsens2Link(ChAvailable()) && !xsens_msg_received[1]) parse_xsens_msg(1, Xsens2Link(Getch())); */ for (int i = 0; i < XSENS_COUNT; i++) { if (xsens_msg_received[i]) { // first make room while (xsens_msg_buf_count[i] >= XSENS_MSG_BUF) { // throwing away old stuff xsens_msg_buf_ci[i] = (xsens_msg_buf_ci[i] + 1 ) % XSENS_MSG_BUF; xsens_msg_buf_count[i]--; } xsens_msg_buf_pi[i] = (xsens_msg_buf_pi[i] + 1 ) % XSENS_MSG_BUF; xsens_msg_buf_count[i]++; //xsens_parse_msg(i); xsens_msg_received[i] = FALSE; } } }
/*------------------------------------------------------*/ void AuxDef (void) { char c; while(Kbhit(CHAUX)) { if(!AuxBuff) Auxp=AuxBuff=memalloc(LINK_LEN); switch(c=Getch(CHAUX)) { case 0x0A: case 0x0D: puts_aux("\r\n"); *Auxp=null; Auxp=AuxBuff; if(!strcmp("?v",Auxp)) SysMessage(CHAUX); puts_aux(">"); break; default: if(Auxp != &AuxBuff[LINK_LEN-1]) *Auxp++=c; else { *Auxp=c; Putch('\b',CHAUX); } Putch(c,CHAUX); break; } } }
void main(int argc, char *argv[]) { int skt; int err, quit=0; int DataBytes; InitLib(); err=NetStart(); if(err<0) { Print("Init Ethernet error.\n\r"); return; } GetIp(MyIp); Print("IP=%d.%d.%d.%d\r\n", MyIp[0], MyIp[1], MyIp[2], MyIp[3]); skt=Nopen("*", "UDP/IP", 10000, 0, S_NOCON | S_NOWA); if(skt<0) { Print("Cannot open a connection for UDP/IP!"); Nterm(); return; } Print("Socket=%d\r\n", skt); SOCKET_NOBLOCK(skt); while(!quit) { YIELD(); // must add this line in the while loop DataBytes=Nread(skt, InBuf, 1500); if(DataBytes>0) { Print("%s\n\r",InBuf); memcpy(OutBuf, InBuf, DataBytes); Nwrite(skt, OutBuf, DataBytes); } if(Kbhit()) { switch(Getch()) { case 'q': case 'Q': quit=1; break; } } } Nclose(skt); Nterm(); }
/*......................................................................*/ void JwRec(void) { static ack_flag; int j; if(Kbhit(CHAUX)) if(CheckTask(JwSend,PIT_task)) switch(j=Getch(CHAUX)) { case ACK_COM: ack_flag = ACK_COM; break; case NACK_COM: JwSend(); break; default: if((ack_flag == ACK_COM) && (j == JwTx[0])) DeleteTask(JwSend,PIT_task); ack_flag = 0; break; } else switch(JwCount) { case 0: JwCount=JwCheck=Getch(CHAUX); if(JwCount > 16) JwCount=0; else{ JwCount++; Jw=JwRx; SetTask(JwDrop,50,PIT_task); } break; case 1: if(JwExe()) { Putch(ACK_COM,CHAUX); Putch(JwRx[0],CHAUX); } else Putch(NACK_COM,CHAUX); JwCount--; DeleteTask(JwDrop,PIT_task); break; default: *Jw = Getch(CHAUX); JwCheck += *Jw++; JwCount--; break; } }
void CActiveConsole::GetNumberL(TUint& aNumber) { OstTraceFunctionEntry0( CACTIVECONSOLE_GETNUMBERL_ENTRY ); TBuf<12> addrAsText; addrAsText.Zero(); if ( aNumber != 0 ) { addrAsText.Format(_L("%d"), aNumber); } WriteNoReturn(_L8("Enter a number: ")); if ( addrAsText.Length() > 0 ) { TBuf8<100> narrowBuf; narrowBuf.Copy(addrAsText); WriteNoReturn(narrowBuf); } TKeyCode code; TBuf<1> character; FOREVER { code = Getch(); character.SetLength(0); character.Append(code); // If <CR> finish editing string if (code == 0x0d) break; // if <BS> remove last character if ((code == 0x08)&&(addrAsText.Length() != 0)) { WriteNoReturn(_L8("%S"),&character); addrAsText.SetLength((addrAsText.Length()-1)); } else { if (addrAsText.Length() < addrAsText.MaxLength()) { WriteNoReturn(_L8("%S"),&character); addrAsText.Append(code); } } } //now extract the new address from the string... if( !addrAsText.Length() ) { addrAsText.Append('0'); //null string causes TLex::Val to return an error } TLex lex(addrAsText); TInt err = lex.Val(aNumber, EDecimal); User::LeaveIfError(err); OstTraceFunctionExit0( CACTIVECONSOLE_GETNUMBERL_EXIT ); }
void link_mcu_event_task( void ) { /* A message has been received */ if (InterMcuBuffer()) { while (InterMcuLink(ChAvailable())&&!intermcu_data.msg_available) intermcu_parse(InterMcuLink(Getch())); } if (intermcu_data.msg_available) { parse_mavpilot_msg(); intermcu_data.msg_available = FALSE; } }
/*......................................................................*/ int JwExe(void) { int i; if(Getch(CHAUX) != JwCheck) return(null); switch(JwRx[0]) { case AZ_DATA: shaft_enable(); i = JwRx[1]*256 + JwRx[2]; az_off += read_AZ()/maxmils*2.0*M_PI - (double)i / 3200.0 * M_PI; break; case IBIT_COM: Ibit |= 0x80; break; default: return(null); } return(eof); }
/*------------------------------------------------------*/ void ReadPc (void) { char c; while(Kbhit(CHPC)) { if(!LinkBuff) Linkp=LinkBuff=memalloc(LINK_LEN); switch(c=Getch(CHPC)) { case 0x0A: case 0x0D: puts_pc("\r\n"); *Linkp=null; Linkp=LinkBuff; PcLinkDecode(Linkp); puts_pc(">"); break; case 0x7F: if(Linkp != LinkBuff) { --Linkp; if(!LPP) puts_pc("\b \b"); } break; default: if(Linkp != &LinkBuff[LINK_LEN-1]) *Linkp++=c; else { *Linkp=c; if(!LPP) Putch('\b',CHPC); } if(!LPP) Putch(c,CHPC); break; } } }
void parse_ins_msg( void ) { while (InsLink(ChAvailable())) { uint8_t ch = InsLink(Getch()); if (CHIMU_Parse(ch, 0, &CHIMU_DATA)) { if(CHIMU_DATA.m_MsgID==0x03) { new_ins_attitude = 1; RunOnceEvery(25, LED_TOGGLE(3) ); if (CHIMU_DATA.m_attitude.euler.phi > M_PI) { CHIMU_DATA.m_attitude.euler.phi -= 2 * M_PI; } EstimatorSetAtt(CHIMU_DATA.m_attitude.euler.phi, CHIMU_DATA.m_attitude.euler.psi, CHIMU_DATA.m_attitude.euler.theta); //EstimatorSetRate(ins_p,ins_q,ins_r); DOWNLINK_SEND_AHRS_EULER(DefaultChannel, DefaultDevice, &CHIMU_DATA.m_attitude.euler.phi, &CHIMU_DATA.m_attitude.euler.theta, &CHIMU_DATA.m_attitude.euler.psi); } } } }
/************************************************************************* 主函数 **************************************************************************/ void main() { uchar key; Init_Com();//串口初始化 count=0; P0=0xbf; fmq=0; while(1) { P1=0x0f; if(P1!=0x0f) { delay(400); key=getkey(); Getch(key); delay(400); } disp(); if(cesi==0){{pwflag = pwcmp();if(pwflag==1){fmq=1;}}} xianshi(); if(QX==1) { mbuf[count]=0; count++; mbuf[count]=0; count++; mbuf[count]=0; count++; mbuf[count]=0; count++; mbuf[count]=0; count++; mbuf[count]=0; xianshi(); QX=0; count=0; } } }
void main() {initsound();readsong("music",song);playsong(-1,song); register int temp;rec3d startpagerec;stick3d titlestick; sks key; char3d title;hz3d prognam; init();mx=getmaxx();my=getmaxy();setbkcolor(0);If=Fpmk;Of=Fc; startpagerec.x1=startpagerec.y1=5;startpagerec.x2=mx-5;startpagerec.y2=my-100;startpagerec.widtho=startpagerec.heighto=10;startpagerec.widthm=10;startpagerec.heightm=15;startpagerec.widthi=startpagerec.heighti=7;startpagerec.fl=SOLID_FILL;startpagerec.fd=SOLID_FILL;startpagerec.fb=SOLID_FILL;startpagerec.bc=4;startpagerec.db=1;startpagerec.draw(); titlestick.x=startpagerec.x1+startpagerec.widtho+startpagerec.widthm+startpagerec.widthi+20;titlestick.y=startpagerec.y1+startpagerec.heighto+startpagerec.heightm+startpagerec.heighti+20;titlestick.wl=titlestick.hu=10;titlestick.wr=titlestick.hd=20;titlestick.wm=150;titlestick.hm=40;titlestick.fl=titlestick.fr=titlestick.fu=titlestick.fd=titlestick.fm=1;titlestick.cl=titlestick.cu=15;titlestick.cr=titlestick.cd=8;titlestick.cm=7;titlestick.bc=1;titlestick.db=1;titlestick.draw(); title.x=titlestick.x+20;title.y=titlestick.y+10;title.horiz=LEFT_TEXT;title.vert=TOP_TEXT;title.fontname=SANS_SERIF_FONT;title.fontdir=HORIZ_DIR;title.fontsize=4;title.c=15;title.co=9;title.depth=5;title.skip=1;title.dir=0;title.st="Pmk100!";title.draw(); titlestick.x=startpagerec.x2-startpagerec.widtho-startpagerec.widthm-startpagerec.widthi-20;titlestick.y=startpagerec.y1+startpagerec.heighto+startpagerec.heightm+startpagerec.heighti+20;titlestick.wl=-10;titlestick.hu=10;titlestick.wr=-20;titlestick.hd=20;titlestick.wm=-190;titlestick.hm=40;titlestick.fl=titlestick.fr=titlestick.fu=titlestick.fd=titlestick.fm=1;titlestick.cl=titlestick.cu=15;titlestick.cr=titlestick.cd=8;titlestick.cm=7;titlestick.bc=1;titlestick.db=1;titlestick.draw(); title.x=titlestick.x+titlestick.wr+titlestick.wm+titlestick.wl+30;title.y=titlestick.y+10;title.horiz=LEFT_TEXT;title.vert=TOP_TEXT;title.fontname=SANS_SERIF_FONT;title.fontdir=HORIZ_DIR;title.fontsize=4;title.c=15;title.co=9;title.depth=5;title.skip=1;title.dir=0;title.st="Made:DanSei";title.draw();prognam.x=mx/2-174;prognam.y=titlestick.y+titlestick.hu+titlestick.hm+titlestick.hd+20;prognam.fontsize=48;prognam.string=rname;prognam.c=0;prognam.co=14;prognam.depth=15;prognam.draw();d24(lib24k,rmade,mx/2-70,my-90,9,5);snhz16(eng16[_mh-1],mx/2-12,my-90,9);d24(lib24k,rds,mx/2+12,my-90,9,5);d16(eng16,vern1eng,mx/2-176,my-60,14,0);d16(eng16,vern2eng,mx/2-48,my-60,14,0);d16(eng16,vern3eng,mx/2+48,my-60,14,0); pmkm.init();pmkm.maxx=mx;pmkm.maxy=my;pmkm.cursor(knife[0]); m3dm mm(5);mm.w.cb=1;mm.it[0].st="System";mm.it[1].st="File";mm.it[2].st="Edit";mm.it[3].st="Config";mm.it[4].st="Translate";mm.it[5].st="Store";mm.set1(set1fn,TRIPLEX_FONT);mm.set1(set1vt,2);mm.set1(set1skp,15);mm.set1(set1fs,3);mm.setxy();mm.set1(set1cy,-5);mm.set1(set1cb,~4);mm.set1(set1cc,~1);mm.draw();mm.run(temp); Getch(key); cmd3d cmd;cmd.c.st="Command3d";cmd.c.fontname=TRIPLEX_FONT;cmd.c.fontsize=2;cmd.c.depth=5; cmd.setxy(stomach); cmd.o.bc=14; cmd.draw(0); while(getch()!=13); cmd.draw(1); getch(); stopsong();quitsound(); }
void parse_ins_msg(void) { while (InsLink(ChAvailable())) { uint8_t ch = InsLink(Getch()); if (CHIMU_Parse(ch, 0, &CHIMU_DATA)) { RunOnceEvery(25, LED_TOGGLE(3)); if (CHIMU_DATA.m_MsgID == CHIMU_Msg_3_IMU_Attitude) { new_ins_attitude = 1; if (CHIMU_DATA.m_attitude.euler.phi > M_PI) { CHIMU_DATA.m_attitude.euler.phi -= 2 * M_PI; } struct FloatEulers att = { CHIMU_DATA.m_attitude.euler.phi, CHIMU_DATA.m_attitude.euler.theta, CHIMU_DATA.m_attitude.euler.psi }; stateSetNedToBodyEulers_f(&att); struct FloatRates rates = { CHIMU_DATA.m_sensor.rate[0], CHIMU_DATA.m_attrates.euler.theta, 0. }; // FIXME rate r stateSetBodyRates_f(&rates); //FIXME ahrs_chimu.is_aligned = TRUE; } else if (CHIMU_DATA.m_MsgID == 0x02) { #if CHIMU_DOWNLINK_IMMEDIATE RunOnceEvery(25, DOWNLINK_SEND_AHRS_EULER(DefaultChannel, DefaultDevice, &CHIMU_DATA.m_sensor.rate[0], &CHIMU_DATA.m_sensor.rate[1], &CHIMU_DATA.m_sensor.rate[2])); #endif } } } }
void digital_cam_uart_event(void) { while (CameraLink(ChAvailable())) { parse_mora(&mora_protocol, CameraLink(Getch())); if (mora_protocol.msg_received) { switch (mora_protocol.msg_id) { case MORA_STATUS: for (int i = 0; i < MORA_STATUS_MSG_SIZE; i++) { mora_status_msg.bin[i] = mora_protocol.payload[i]; } digital_cam_uart_status = mora_status_msg.data.shots; break; case MORA_PAYLOAD: for (int i = 0; i < MORA_PAYLOAD_MSG_SIZE; i++) { thumbs[thumb_pointer][i] = mora_protocol.payload[i]; } break; default: break; } mora_protocol.msg_received = 0; } } }
char *GetHistory() { int ch, tmp; int start_x; char *RetVal = NULL; History *TMP; int hide_left, hide_right; disp_begin_pos = 0; cursor_pos = 0; start_x = 0; /* leaveok(stdscr, TRUE); */ (void) DisplayHistory(); do { RefreshWindow( history_window ); doupdate(); ch = Getch(); if(ch != -1 && ch != KEY_RIGHT && ch != KEY_LEFT) { if(start_x) { start_x = 0; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); } } switch( ch ) { case -1: RetVal = NULL; break; case ' ': break; /* Quick-Key */ case KEY_RIGHT: start_x++; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); if(hide_right < 0) start_x--; break; case KEY_LEFT: if(start_x > 0) start_x--; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); break; case '\t': case KEY_DOWN: if (disp_begin_pos + cursor_pos+1 >= total_hist) { beep(); } else { if( cursor_pos + 1 < HISTORY_WINDOW_HEIGHT ) { PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HST_COLOR, start_x, &hide_left, &hide_right); cursor_pos++; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); } else { PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HST_COLOR, start_x, &hide_left, &hide_right); scroll( history_window ); disp_begin_pos++; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); } } break; case KEY_BTAB: case KEY_UP : if( disp_begin_pos + cursor_pos - 1 < 0 ) { beep(); } else { if( cursor_pos - 1 >= 0 ) { PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HST_COLOR, start_x, &hide_left, &hide_right); cursor_pos--; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); } else { PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HST_COLOR, start_x, &hide_left, &hide_right); wmove( history_window, 0, 0 ); winsertln( history_window ); disp_begin_pos--; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); } } break; case KEY_NPAGE: if( disp_begin_pos + cursor_pos >= total_hist - 1 ) { beep(); } else { if( cursor_pos < HISTORY_WINDOW_HEIGHT - 1 ) { PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HST_COLOR, start_x, &hide_left, &hide_right); if( disp_begin_pos + HISTORY_WINDOW_HEIGHT > total_hist - 1 ) cursor_pos = total_hist - disp_begin_pos - 1; else cursor_pos = HISTORY_WINDOW_HEIGHT - 1; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); } else { if( disp_begin_pos + cursor_pos + HISTORY_WINDOW_HEIGHT < total_hist ) { disp_begin_pos += HISTORY_WINDOW_HEIGHT; cursor_pos = HISTORY_WINDOW_HEIGHT - 1; } else { disp_begin_pos = total_hist - HISTORY_WINDOW_HEIGHT; if( disp_begin_pos < 0 ) disp_begin_pos = 0; cursor_pos = total_hist - disp_begin_pos - 1; } DisplayHistory(); } } break; case KEY_PPAGE: if( disp_begin_pos + cursor_pos <= 0 ) { beep(); } else { if( cursor_pos > 0 ) { PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HST_COLOR, start_x, &hide_left, &hide_right); cursor_pos = 0; PrintHstEntry( disp_begin_pos + cursor_pos, cursor_pos, HIHST_COLOR, start_x, &hide_left, &hide_right); } else { if( (disp_begin_pos -= HISTORY_WINDOW_HEIGHT) < 0 ) { disp_begin_pos = 0; } cursor_pos = 0; DisplayHistory(); } } break; case KEY_HOME: if( disp_begin_pos == 0 && cursor_pos == 0 ) { beep(); } else { disp_begin_pos = 0; cursor_pos = 0; DisplayHistory(); } break; case KEY_END : disp_begin_pos = MAX(0, total_hist - HISTORY_WINDOW_HEIGHT); cursor_pos = total_hist - disp_begin_pos - 1; DisplayHistory(); break; case LF : case CR : TMP = Hist; for(tmp = 0; (tmp != disp_begin_pos + cursor_pos); tmp++) { TMP = TMP -> next; if (TMP == NULL) break; } if (TMP != NULL) RetVal = TMP -> hst; else RetVal = NULL; break; case ESC: RetVal = NULL; break; default : beep(); break; } /* switch */ } while(ch != CR && ch != ESC && ch != -1); /* leaveok(stdscr, FALSE); */ touchwin(stdscr); return RetVal; }
void airspeed_otf_event(void) { while (MetLink(ChAvailable())) { uint8_t ch = MetLink(Getch()); airspeed_otf_parse(ch); } }
void aerocomm_init( void ) { aerocomm_confirmation_received=TRUE; { uint8_t init_cpt = 120; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } #ifdef NO_API_INIT #warning "NO_API_INIT defined" #else #warning "NO_API_INIT not defined" #endif #ifndef NO_API_INIT /** Switching to AT mode (FIXME: busy waiting) */ AerocommPrintString(AT_COMMAND_SEQUENCE); char c; while (!AerocommLink(ChAvailable())) { uint8_t init_cpt = 3; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } int j; j=0; while (AerocommLink(ChAvailable()) && j<4) { c=AerocommLink(Getch()); j++; } uint16_t addr = AEROCOMM_MY_ADDR; char s[]=AT_SET_MY; s[4]=(unsigned int)(0x00); s[5]=(unsigned int)(0x50); s[6]=(unsigned int)(0x67); s[7]=(unsigned int)(0x00); s[8]=(unsigned int)(addr>> 8); s[9]=(unsigned int)(addr & 0xff); AerocommPrintString(AT_READ_MY); while (!AerocommLink(ChAvailable())) { uint8_t init_cpt = 3; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } j=0; while (AerocommLink(ChAvailable()) && j<4) { c=AerocommLink(Getch()); j++; } if (c!=s[9]) for (j=0; j<10; j++) AerocommTransportPut1Byte(s[j]); while (!AerocommLink(ChAvailable())) { uint8_t init_cpt = 3; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } j=0; while (AerocommLink(ChAvailable()) && j<3) { c=AerocommLink(Getch()); j++; } AerocommPrintString(AT_RESET); { uint8_t init_cpt = 60; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } AerocommPrintString(AT_COMMAND_SEQUENCE); while (!AerocommLink(ChAvailable())) { uint8_t init_cpt = 3; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } j=0; while (AerocommLink(ChAvailable()) && j<4) { c=AerocommLink(Getch()); j++; } AerocommPrintString(AT_AP_MODE); while (!AerocommLink(ChAvailable())) { uint8_t init_cpt = 3; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } j=0; while (AerocommLink(ChAvailable()) && j<2) { c=AerocommLink(Getch()); j++; } char s1[]=AT_DEST_ADDR; s1[2]=(unsigned int)(0x00); s1[3]=(unsigned int)(0x01); s1[4]=(unsigned int)(0x00); for (j=0; j<5; j++) AerocommTransportPut1Byte(s1[j]); while (!AerocommLink(ChAvailable())) { uint8_t init_cpt = 3; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } j=0; while (AerocommLink(ChAvailable()) && j<4) { c=AerocommLink(Getch()); j++; } AerocommPrintString(AT_EXIT); while (!AerocommLink(ChAvailable())) { uint8_t init_cpt = 3; while (init_cpt) { if (sys_time_periodic()) init_cpt--; } } j=0; while (AerocommLink(ChAvailable()) && j<4) { c=AerocommLink(Getch()); j++; } #endif }