Revision 7115c3a4 examples/meka/src/mekajointinterface.cpp
examples/meka/src/mekajointinterface.cpp | ||
---|---|---|
23 | 23 |
//store data: |
24 | 24 |
if (id != -1){ |
25 | 25 |
//printf("> storing joint data for joint id %d\n", id); |
26 |
if (i >= msg.position.size()){ |
|
27 |
printf("> msg is missing position data for joint %s. exiting! make sure you did start the publisher...\n", name.c_str()); |
|
28 |
exit(EXIT_FAILURE); |
|
29 |
} |
|
30 |
if (i >= msg.velocity.size()){ |
|
31 |
printf("> msg is missing velocity data for joint %s. exiting! make sure you did start the publisher...\n", name.c_str()); |
|
32 |
exit(EXIT_FAILURE); |
|
33 |
} |
|
34 |
//ok, safe to access data |
|
26 | 35 |
JointInterface::store_incoming_position(id, msg.position[i], timestamp); |
27 | 36 |
JointInterface::store_incoming_speed( id, msg.velocity[i], timestamp); |
28 | 37 |
} |
Also available in: Unified diff