72 lines (57 with data), 2.2 kB

// ************************************
// Drivers for the right arm
// ************************************


#if BM_ARM_RIGHT & (BM_ARM_SHOULDER_RHYTHM == OFF)
//Sterno clavicular joint driver
AnyKinEqInterPolDriver SCDriverRight ={
  AnyKinMeasure& ref1 =...BodyModel.Interface.Right.SternoClavicularProtraction;
  AnyKinMeasure& ref2 =...BodyModel.Interface.Right.SternoClavicularElevation;
  Data = pi/180*{
    .JntPos.Right.SternoClavicularProtractionVec,
    .JntPos.Right.SternoClavicularElevationVec
  };
  
  T=.JntPos.Right.SternoClavicularTime;
  Type=Bspline   ;
  Reaction.Type={Off,Off};
};
#endif

//Glenohumeral joint 
AnyKinEqInterPolDriver GHDriverRight={
  AnyKinMeasure& ref1 =...BodyModel.Interface.Right.GlenohumeralAbduction;
  AnyKinMeasure& ref2 =...BodyModel.Interface.Right.GlenohumeralFlexion;
  AnyKinMeasure& ref3 =...BodyModel.Interface.Right.GlenohumeralExternalRotation;
  
  Data=pi/180*{
    .JntPos.Right.GlenohumeralAbductionVec,  //GH joint
    .JntPos.Right.GlenohumeralFlexionVec,  //GH joint
    .JntPos.Right.GlenohumeralExternalRotationVec  //GH joint
  };    
  T=.JntPos.Right.GlenohumeralTime;
  Type=Bspline;
  
  Reaction.Type={Off,Off,Off};
};


//Elbow flexion driver  
AnyKinEqInterPolDriver ElbowFlexionDriverRight={
  AnyKinMeasureOrg  &Elbow =...BodyModel.Interface.Right.ElbowFlexion;
  Data=pi/180*{.JntPos.Right.ElbowFlexionVec};  
  T=.JntPos.Right.ElbowFlexionTime;
  Type=Bspline;
  Reaction.Type={Off};
};

//Elbow pronation driver
AnyKinEqInterPolDriver ElbowPronationDriverRight={
  AnyKinMeasure& Elbow =...BodyModel.Interface.Right.ElbowPronation;
  
  Data= pi/180*{.JntPos.Right.ElbowPronationVec };  
  T=.JntPos.Right.ElbowPronationTime;
  Type=Bspline;    Reaction.Type={Off};
};

//Wrist driver 
AnyKinEqInterPolDriver WristDriverRight ={
  AnyKinMeasure& ref1 =...BodyModel.Interface.Right.WristFlexion;
  AnyKinMeasure& ref2 =...BodyModel.Interface.Right.WristAbduction;
  Data = pi/180*{
    .JntPos.Right.WristFlexionVec,
    .JntPos.Right.WristAbductionVec};
    Type=Bspline;

  T=.JntPos.Right.WristTime;
  Reaction.Type={Off,Off};
};