Revision b0d48d96
| examples/meka/src/mekajointinterface.cpp | ||
|---|---|---|
| 34 | 34 | 
    return;  | 
| 35 | 35 | 
    }  | 
| 36 | 36 | 
    //ok, safe to access data  | 
| 37 | 
    JointInterface::store_incoming_position(id, 180.0 / M_PI * msg.position[i], timestamp);  | 
|
| 38 | 
    JointInterface::store_incoming_speed( id, 180.0 / M_PI * msg.velocity[i], timestamp);  | 
|
| 37 | 
                if (id == ID_NECK_PAN){
   | 
|
| 38 | 
    //joint is inverted  | 
|
| 39 | 
    JointInterface::store_incoming_position(id, -180.0 / M_PI * msg.position[i], timestamp);  | 
|
| 40 | 
    JointInterface::store_incoming_speed( id, -180.0 / M_PI * msg.velocity[i], timestamp);  | 
|
| 41 | 
                }else if (id == ID_NECK_TILT){
   | 
|
| 42 | 
    JointInterface::store_incoming_position(id, 180.0 / M_PI * msg.position[i], timestamp);  | 
|
| 43 | 
    JointInterface::store_incoming_speed( id, 180.0 / M_PI * msg.velocity[i], timestamp);  | 
|
| 44 | 
    }  | 
|
| 39 | 45 | 
    }  | 
| 40 | 46 | 
    }  | 
| 41 | 47 | 
     | 
Also available in: Unified diff