82 lines (68 with data), 2.4 kB

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

  
  #if BM_ARM_SHOULDER_RHYTHM == 0
  //Sterno clavicular joint driver
  AnyKinEqSimpleDriver SCDriverRight ={
    AnyKinMeasure& ref1 =...BodyModel.Interface.Right.SternoClavicularProtraction;
    AnyKinMeasure& ref2 =...BodyModel.Interface.Right.SternoClavicularElevation;
    DriverPos = pi/180*{
      .JntPos.Right.SternoClavicularProtraction,
      .JntPos.Right.SternoClavicularElevation
    };
    DriverVel = {
      .JntVel.Right.SternoClavicularProtraction,
      .JntVel.Right.SternoClavicularElevation
    };
    Reaction.Type={Off,Off};
  };
  #endif
 
  AnyKinEqSimpleDriver GHDriverRight=
  {
    AnyKinMeasure& ref1 =...BodyModel.Interface.Right.GlenohumeralAbduction;
    AnyKinMeasure& ref2 =...BodyModel.Interface.Right.GlenohumeralFlexion;
    AnyKinMeasure& ref3 =...BodyModel.Interface.Right.GlenohumeralExternalRotation;

     DriverPos=pi/180*
     {
      .JntPos.Right.GlenohumeralAbduction,  
      .JntPos.Right.GlenohumeralFlexion,  
      .JntPos.Right.GlenohumeralExternalRotation  
     };
     DriverVel = pi/180*
     {
      .JntVel.Right.GlenohumeralAbduction,  
      .JntVel.Right.GlenohumeralFlexion,  
      .JntVel.Right.GlenohumeralExternalRotation 
     };    
     Reaction.Type={Off, Off, Off};
  };

  AnyKinEqSimpleDriver ElbowFEDriverRight=
  {
    AnyKinMeasureOrg  &Elbow =...BodyModel.Interface.Right.ElbowFlexion;
    DriverPos = pi/180*{.JntPos.Right.ElbowFlexion};  
    DriverVel = pi/180*{.JntVel.Right.ElbowFlexion};  
    Reaction.Type={Off};
  };
  
  AnyKinEqSimpleDriver ElbowPSDriverRight=
  {
    AnyKinMeasure& Elbow =...BodyModel.Interface.Right.ElbowPronation;
    DriverPos = pi/180*{.JntPos.Right.ElbowPronation };  
    DriverVel = pi/180*{.JntVel.Right.ElbowPronation };  
    Reaction.Type={Off};
  };

  AnyKinEqSimpleDriver WristDriverRight =
  {
    AnyKinMeasure& ref1 =...BodyModel.Interface.Right.WristFlexion;
    AnyKinMeasure& ref2 =...BodyModel.Interface.Right.WristAbduction;
    DriverPos = pi/180*
    {
      .JntPos.Right.WristFlexion,
      .JntPos.Right.WristAbduction
    };

    DriverVel = pi/180*
    {
      .JntVel.Right.WristFlexion,
      .JntVel.Right.WristAbduction
    };
    Reaction.Type={Off,Off};
  };