Revision b0d48d96

View differences:

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