Revision 55a4b313 examples/yarp_icub/src/icub_data_receiver.cpp
examples/yarp_icub/src/icub_data_receiver.cpp | ||
---|---|---|
36 | 36 |
for(int i=0; i<positions.size(); i++){ |
37 | 37 |
icub_jointinterface->fetch_position(i, positions[i], timestamps[i]); |
38 | 38 |
icub_jointinterface->fetch_speed(i, velocities[i], timestamps[i]); |
39 |
if (i==iCubJointInterface::ICUB_ID_NECK_PAN){ |
|
40 |
printf("\nMMM p=%f v=%f\n",positions[i],velocities[i]); |
|
41 |
} |
|
39 | 42 |
} |
40 | 43 |
|
41 | 44 |
//printf("\n%f %f %f TIME\n", get_timestamp_ms(), timestamps[2], positions[2]); |
Also available in: Unified diff