Spiri
/
ROSBuzz_MISTLab
13
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

msg receive bug debug

This commit is contained in:
vivek-shankar 2017-01-27 09:31:42 -05:00
parent a857272acb
commit c1141fddc1
2 changed files with 4 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
src/buzz_utility.cpp
View File

@ -86,6 +86,7 @@ namespace buzz_utility{
uint16_t unMsgSize; uint16_t unMsgSize;
uint8_t is_msg_pres=*(uint8_t*)(pl + tot); uint8_t is_msg_pres=*(uint8_t*)(pl + tot);
tot+=sizeof(uint8_t); tot+=sizeof(uint8_t);
fprintf(stdout,"is_updater msg present : %i\n",(int)is_msg_pres);
if(is_msg_pres){ if(is_msg_pres){
unMsgSize = *(uint16_t*)(pl + tot); unMsgSize = *(uint16_t*)(pl + tot);
tot+=sizeof(uint16_t); tot+=sizeof(uint16_t);
@ -128,8 +129,8 @@ namespace buzz_utility{
tot += sizeof(uint16_t); tot += sizeof(uint16_t);
uint8_t updater_msg_pre = 0; uint8_t updater_msg_pre = 0;
uint16_t updater_msgSize= 0; uint16_t updater_msgSize= 0;
if((int)get_update_mode()!=CODE_RUNNING && is_msg_present()){ if((int)get_update_mode()!=CODE_RUNNING && is_msg_present()==1){
//fprintf(stdout,"transfer code %d\n", transfer_code); fprintf(stdout,"transfer code \n");
updater_msg_pre =1; updater_msg_pre =1;
//transfer_code=0; //transfer_code=0;
*(uint8_t*)(buff_send + tot) = (uint8_t)updater_msg_pre; *(uint8_t*)(buff_send + tot) = (uint8_t)updater_msg_pre;

1
src/roscontroller.cpp
View File

@ -184,6 +184,7 @@ namespace rosbzz_node{
else ROS_ERROR("Failed to call service from flight controller"); else ROS_ERROR("Failed to call service from flight controller");
} }
/*obtain Pay load to be sent*/ /*obtain Pay load to be sent*/
fprintf(stdout, "before getting msg from utility\n");
uint64_t* payload_out_ptr= buzz_utility::out_msg_process(); uint64_t* payload_out_ptr= buzz_utility::out_msg_process();
uint64_t position[3]; uint64_t position[3];
/*Appened current position to message*/ /*Appened current position to message*/