Revision 7115c3a4
| 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