45 lines (37 with data), 1.0 kB

AnyFolder Cylinder = {
  
  AnyFloat ScaleFactor ??= 1;
  AnyFloat LengthScale ??= 1;
  
  AnySeg Segment = {
    Mass=1e-5;
    Jii ??= {0, 0, 0};
    r0 ??= {0,0,0};    
    Axes0 ??= eye(3);
        
    AnyRefNode node1 = {
       sRel = {0, 0, 0.0} * ..ScaleFactor;
       
       //AnyDrawRefFrame drw = {RGB={1,0,0};};
       
      AnySurfCylinder Surf = {
        Length = ...LengthScale * vnorm( ..node2.sRel-..node1.sRel );
        Radius = 0.014 * ...ScaleFactor;
      };
    };
    AnyRefNode node2 = { 
      sRel = {0, 0, 0.13} * ..ScaleFactor; 
    };
  };

  AnyUniversalJoint ThoraxAttachement = {
    AnyRefFrame &ref1 = .StartNode;
    AnyRefFrame &ref2 = .Segment.node1;
    Axis1 = x;
    Axis2 = y;
  };

  AnyKinEqSimpleDriver DirectionDriver = {
    AnyKinLinear Lin = {
      AnyRefFrame &ref1 = ..Segment.node2;
      AnyRefFrame &ref2 = ..EndNode;
      Ref = 0;
    };
    DriverPos = {0,0};
    DriverVel = {0,0};
    MeasureOrganizer = {0,1};
  };
  
};