Creating A System In Chrono (demo_CH_buildsystem.cpp)
// =============================================================================
// PROJECT CHRONO - http://projectchrono.org
//
// Copyright (c) 2014 projectchrono.org
// All rights reserved.
//
// Use of this source code is governed by a BSD-style license that can be found
// in the LICENSE file at the top level of the distribution and at
// http://projectchrono.org/license-chrono.txt.
//
// =============================================================================
// Authors: Alessandro Tasora
// =============================================================================
//
// Demo code about
//
// - creating a physical system
// - add/remove rigid bodies
// - create mechanical joints between bodies
// - perform a simulation
//
// =============================================================================
#include "chrono/physics/ChLinkMotorRotationSpeed.h"
#include "chrono/physics/ChSystemNSC.h"
using namespace chrono;
int main(int argc, char* argv[]) {
GetLog() << "Copyright (c) 2017 projectchrono.org\nChrono version: " << CHRONO_VERSION << "\n\n";
{
//
// EXAMPLE 1:
//
GetLog() << " Example: create a physical system.. \n";
// The physical system: it contains all physical objects.
ChSystemNSC my_system;
// Create a bunch of rigid bodies..
// Note that we use shared pointers, so you don't
// have to care about the deletion (never use delete.. for
// objects managed with shared pointers! it will be automatic!)
auto my_body_A = chrono_types::make_shared<ChBody>();
auto my_body_B = chrono_types::make_shared<ChBody>();
auto my_body_C = chrono_types::make_shared<ChBody>();
// Create some markers..
// Markers are 'auxiliary coordinate systems' to be added
// to rigid bodies.
// Again, note that they are managed by shared pointers.
auto my_marker_a1 = chrono_types::make_shared<ChMarker>();
auto my_marker_a2 = chrono_types::make_shared<ChMarker>();
auto my_marker_b1 = chrono_types::make_shared<ChMarker>();
auto my_marker_b2 = chrono_types::make_shared<ChMarker>();
// You can create some forces too...
auto my_force_a1 = chrono_types::make_shared<ChForce>();
auto my_force_a2 = chrono_types::make_shared<ChForce>();
// Here you will add forces and markers to rigid
// bodies.
// Note: the same marker shouldn't be added to multiple bodies.
my_body_A->AddMarker(my_marker_a1);
my_body_A->AddMarker(my_marker_a2);
my_body_A->AddForce(my_force_a1);
my_body_A->AddForce(my_force_a2);
my_body_B->AddMarker(my_marker_b1);
my_body_B->AddMarker(my_marker_b2);
// Ok, remember that rigid bodies must be added to
// the physical system.
my_system.AddBody(my_body_A);
my_system.AddBody(my_body_B);
my_system.AddBody(my_body_C);
// Show the hierarchy in the shell window...
GetLog() << "Here's the system hierarchy which you built: \n\n ";
my_system.ShowHierarchy(GetLog());
// Do you want to remove items? Use the
// Remove...() functions.
my_body_A->RemoveAllForces();
// Remove a single body..
my_system.RemoveBody(my_body_A);
// Add markers to another body...
my_body_B->AddMarker(my_marker_a1);
my_body_B->AddMarker(my_marker_a2);
my_body_B->AddForce(my_force_a1);
my_body_B->AddForce(my_force_a2);
// By the way, you can set an Ascii name for objects as desired:
my_marker_a1->SetName("JohnFoo");
// ..so you can later use my_body_B.SearchMarker("JohnFoo"); etc.
GetLog() << "\n\n\nHere's the system hierarchy after modifications: \n\n ";
my_system.ShowHierarchy(GetLog());
}
{
//
// EXAMPLE 2:
//
GetLog() << " Example: create a slider-crank system: \n";
// The physical system: it contains all physical objects.
ChSystemNSC my_system;
// Create three rigid bodies and add them to the system:
auto my_body_A = chrono_types::make_shared<ChBody>();
auto my_body_B = chrono_types::make_shared<ChBody>();
auto my_body_C = chrono_types::make_shared<ChBody>();
my_body_A->SetName("truss");
my_body_B->SetName("crank");
my_body_C->SetName("rod");
my_system.AddBody(my_body_A);
my_system.AddBody(my_body_B);
my_system.AddBody(my_body_C);
// Set initial position of the bodies (center of mass)
my_body_A->SetBodyFixed(true); // truss does not move!
my_body_B->SetPos(ChVector<>(1, 0, 0));
my_body_C->SetPos(ChVector<>(4, 0, 0));
// Create two markers and add them to two bodies:
// they will be used as references for 'rod-crank'link.
auto my_marker_b = chrono_types::make_shared<ChMarker>();
auto my_marker_c = chrono_types::make_shared<ChMarker>();
my_marker_b->SetName("crank_rev");
my_marker_c->SetName("rod_rev");
my_body_B->AddMarker(my_marker_b);
my_body_C->AddMarker(my_marker_c);
// Set absolute position of the two markers,
// for the initial position of the 'rod-crank' link:
my_marker_b->Impose_Abs_Coord(ChCoordsys<>(ChVector<>(2, 0, 0)));
my_marker_c->Impose_Abs_Coord(ChCoordsys<>(ChVector<>(2, 0, 0)));
// Now create a mechanical link (a revolute joint)
// between these two markers, and insert in system:
auto my_link_BC = chrono_types::make_shared<ChLinkLockRevolute>();
my_link_BC->Initialize(my_marker_b, my_marker_c);
my_link_BC->SetName("REVOLUTE crank-rod");
my_system.AddLink(my_link_BC);
// Phew! All this 'marker' stuff is boring!
// Note that there's an easier way to create a link,
// without needing the two markers (they will be
// automatically created and added to the two bodies)
// i.e. is using two bodies and a position as arguments..
// For example, to create the rod-truss constraint:
auto my_link_CA = chrono_types::make_shared<ChLinkLockPointLine>();
my_link_CA->Initialize(my_body_C, my_body_A, ChCoordsys<>(ChVector<>(6, 0, 0)));
my_system.AddLink(my_link_CA);
my_link_CA->GetMarker1()->SetName("rod_poinline");
my_link_CA->GetMarker2()->SetName("truss_pointline");
my_link_CA->SetName("POINTLINE rod-truss");
// Now create a 'motor' link between crank and truss, in 'imposed speed' mode:
auto my_motor_AB = chrono_types::make_shared<ChLinkMotorRotationSpeed>();
my_motor_AB->SetName("MOTOR truss-crank");
my_motor_AB->Initialize(my_body_A, my_body_B, ChFrame<>(ChVector<>(0, 0, 0)));
my_motor_AB->SetSpeedFunction(chrono_types::make_shared<ChFunction_Const>(CH_C_PI));
my_system.AddLink(my_motor_AB);
GetLog() << "\n\n\nHere's the system hierarchy for slider-crank: \n\n ";
my_system.ShowHierarchy(GetLog());
GetLog() << "Now use an interator to scan through already-added constraints:\n\n";
for (auto link : my_system.Get_linklist()) {
GetLog() << " Link class: " << typeid(link).name() << "\n";
}
// OK! NOW GET READY FOR THE DYNAMICAL SIMULATION!
// A very simple simulation loop..
double chronoTime = 0;
while (chronoTime < 2.5) {
chronoTime += 0.01;
// PERFORM SIMULATION UP TO chronoTime
my_system.DoFrameDynamics(chronoTime);
// Print something on the console..
GetLog() << "Time: " << chronoTime
<< " Slider X position: " << my_link_CA->GetMarker1()->GetAbsCoord().pos.x()
<< " Engine torque: " << my_motor_AB->GetMotorTorque() << "\n";
}
}
return 0;
}
COORDSYS:
Definition: ChCoordsys.h:38
ChLog & GetLog()
Global function to get the current ChLog object.
Definition: ChLog.cpp:39
virtual void AddLink(std::shared_ptr< ChLinkBase > link)
Attach a link to the underlying assembly.
Definition: ChSystem.h:268
bool DoFrameDynamics(double end_time)
Performs integration until the m_endtime is exactly reached, but current time step may be automatical...
Definition: ChSystem.cpp:1669
ChFrame: a class for coordinate systems in 3D space.
Definition: ChFrame.h:42
Definition of general purpose 3d vector variables, such as points in 3D.
Definition: ChVector.h:35
void ShowHierarchy(ChStreamOutAscii &m_file, int level=0) const
Write the hierarchy of contained bodies, markers, etc.
Definition: ChSystem.h:397
virtual void AddBody(std::shared_ptr< ChBody > body)
Attach a body to the underlying assembly.
Definition: ChSystem.h:265
virtual void RemoveBody(std::shared_ptr< ChBody > body)
Remove a body from this assembly.
Definition: ChSystem.h:294
Main namespace for the Chrono package.
Definition: ChAsset.cpp:18
const std::vector< std::shared_ptr< ChLinkBase > > & Get_linklist() const
Get the list of links.
Definition: ChSystem.h:320
Class for a physical system in which contact is modeled using a non-smooth (complementarity-based) me...
Definition: ChSystemNSC.h:29