a b/Tools/Templates/Human Standing/Model/LeftFootDrivers.any
1
//  AnyReacForce LeftFootReaction = {
2
//    
3
//    AnyKinLinear LeftFootLinMeasure = {
4
//      AnySeg &ref1=....BodyModel.Left.Leg.Seg.Foot;
5
//      AnyFixedRefFrame &ref2 = ....Environment.GlobalRef;
6
//    };
7
//    AnyKinRotational LeftFootRotMeasure = {
8
//      AnySeg &ref1=....BodyModel.Left.Leg.Seg.Foot;
9
//      AnyFixedRefFrame &ref2 = ....Environment.GlobalRef;
10
//      Type = RotVector;
11
//
12
//    };  
13
//  };
14
15
16
17
  // Place the Left toe and heel on the ground
18
  AnyKinEqSimpleDriver LToeGroundConstraint ={
19
    AnyKinLinear ToePos = {
20
      AnyFixedRefFrame &Ground = ....Environment.GlobalRef;
21
      AnyRefNode &Ball = ....BodyModel.Left.Leg.Seg.Foot.BigToeNode;
22
    };
23
   MeasureOrganizer = {1};  // Only the y coordinate
24
    DriverPos = {0.0};
25
    DriverVel = {0};
26
    Reaction.Type = {Off};   // Provide ground reaction forces
27
  
28
  };
29
  
30
  AnyKinEqSimpleDriver LHeelGroundConstraint ={
31
    AnyKinLinear HeelPos = {
32
      AnyFixedRefFrame &Ground = ....Environment.GlobalRef;
33
      #if BM_LEG_MODEL == _LEG_MODEL_LEG_      
34
        AnyRefNode &Ball = ....BodyModel.Left.Leg.Seg.Foot.HeelJoint;
35
      #else
36
        AnyRefNode &Ball = ....BodyModel.Left.Leg.Seg.Foot.HeelContactNodeLow;
37
      #endif
38
    };
39
    MeasureOrganizer = {1};  // Only the y coordinate
40
    DriverPos = {0.0};
41
    DriverVel = {0};
42
    Reaction.Type = {Off};   // Provide ground reaction forces
43
  };
44
45
  
46
    // Position the Ankles Left above the z axis
47
  AnyKinEqSimpleDriver LAnkleX = {
48
    AnyKinLinear AnklePos = {
49
      AnyFixedRefFrame &Ground = ....Environment.GlobalRef;
50
      #if BM_LEG_MODEL == _LEG_MODEL_LEG_
51
        AnyRefNode &Ankle = ....BodyModel.Left.Leg.Seg.Foot.AnkleJoint;
52
      #else
53
        AnyRefNode &Ankle = ....BodyModel.Left.Leg.Seg.Foot.SubTalarJoint;
54
      #endif      
55
    };
56
    MeasureOrganizer = {0};  // Only the x coordinate
57
    DriverPos = {0.0};
58
    DriverVel = {0.0};
59
    Reaction.Type = {Off};
60
  };
61
62