Revision ade7a207
| examples/meka/src/mekajointinterface.cpp | ||
|---|---|---|
| 59 | 59 | 
                if (id == ID_NECK_PAN){
   | 
| 60 | 60 | 
    //joint is inverted  | 
| 61 | 61 | 
    JointInterface::store_incoming_position(id, -180.0 / M_PI * msg.position[i], timestamp);  | 
| 62 | 
                    JointInterface::store_incoming_speed(   id, -180.0 / M_PI * msg.velocity[i], timestamp);
   | 
|
| 62 | 
                    JointInterface::store_incoming_velocity(id, -180.0 / M_PI * msg.velocity[i], timestamp);
   | 
|
| 63 | 63 | 
                }else if (id == ID_NECK_TILT){
   | 
| 64 | 64 | 
    JointInterface::store_incoming_position(id, 180.0 / M_PI * msg.position[i], timestamp);  | 
| 65 | 
                    JointInterface::store_incoming_speed(   id, 180.0 / M_PI * msg.velocity[i], timestamp);
   | 
|
| 65 | 
                    JointInterface::store_incoming_velocity(id, 180.0 / M_PI * msg.velocity[i], timestamp);
   | 
|
| 66 | 66 | 
    }  | 
| 67 | 67 | 
    }  | 
| 68 | 68 | 
    }  | 
| ... | ... | |
| 93 | 93 | 
     | 
| 94 | 94 | 
    void MekaJointInterface::store_dummy_data(int id, double timestamp){
   | 
| 95 | 95 | 
    JointInterface::store_incoming_position(id, 0.0, timestamp);  | 
| 96 | 
        JointInterface::store_incoming_speed(id, 0.0, timestamp);
   | 
|
| 96 | 
        JointInterface::store_incoming_velocity(id, 0.0, timestamp);
   | 
|
| 97 | 97 | 
    }  | 
| 98 | 98 | 
     | 
| 99 | 99 | 
    //! constructor  | 
Also available in: Unified diff