void joint5callback(int iValue, void *userData)
{
sense(5) = iValue;
arm.set_joint(sense(5), 5);
}
void joint4callback(int iValue, void *userData)
{
sense(4) = iValue - 90;
arm.set_joint(sense(4), 4);
}
void joint3callback(int iValue, void *userData)
{
sense(3) = iValue - 90;
arm.set_joint(sense(3), 3);
}
void joint2callback(int iValue, void *userData)
{
sense(2) = iValue;
arm.set_joint(sense(2), 2);
}
void joint1callback(int iValue, void *userData)
{
sense(1) = iValue - 90;
arm.set_joint(sense(1), 1);
}
// These are the callbacks
void joint0callback(int iValue, void *userData)
{
sense(0) = iValue - 90;
arm.set_joint(sense(0), 0);
}