Revision 351f71d1
ID | 351f71d1d892ddeecb2827a6599eba4575c53bf4 |
adding maps for warehouse and fixing strtok issue in wh_robot that massed up curr_task
scout/libscout/src/behaviors/WH_Robot.cpp | ||
---|---|---|
93 | 93 |
{ |
94 | 94 |
ROS_INFO("WH_ROBOT: Setting robot task"); |
95 | 95 |
char* string = (char*)msg->data.c_str(); |
96 |
ROS_INFO("Set task string is: %s", string); |
|
96 | 97 |
char* data; |
97 | 98 |
data = strtok(string, " "); |
99 |
data = strtok(NULL, " "); |
|
98 | 100 |
int order_id = atoi(data); |
99 |
data = strtok(string, " "); |
|
101 |
ROS_INFO("order Id: %d with string %s", order_id, data); |
|
102 |
|
|
103 |
data = strtok(NULL, " "); |
|
100 | 104 |
Address source = atoi(data); |
101 |
data = strtok(string, " "); |
|
105 |
ROS_INFO("source: %d with string %s", source, data); |
|
106 |
|
|
107 |
data = strtok(NULL, " "); |
|
102 | 108 |
Address dest = atoi(data); |
109 |
ROS_INFO("dest: %d with string %s", dest, data); |
|
110 |
|
|
103 | 111 |
Time start_time = ros::Time::now(); |
104 | 112 |
Path path; |
105 | 113 |
path.len = 0; |
Also available in: Unified diff