【Chrono Engine学习总结】4-vehicle-4.1-vehicle的基本概念

由于Chrono的官方教程在一些细节方面解释的并不清楚，自己做了一些尝试，做学习总结。

1、基本介绍

Vehicle Overview
Vehicle Mannel
Vehicle的官方demo

1.1 Vehicle的构型

• 一个车辆由许多子系统构成：悬挂、转向、轮子/履带、刹车/油门、动力传统系统(driverline)。
• Chrono提供了一些典型的车辆模型，例如：悍马车、小型轿车等 vehicle models，只需要直接代码选定即可；
• 如果不用官方的车型，就需要自己定义各种子系统。chono提供一些典型的子系统构型，例如悬挂包括：双横臂、前麦花臣支柱等 悬挂类型，转向包括：转向垂臂( Pitman arm)等转向类型。
• 如果连官方的子系统都不想用，就需要自己定义一些弹簧/轴的连接，就复杂一些，一般采用JSON文件的方式，这样比较清晰明了。

1.2 Vehicle部分仿真的逻辑

https://api.projectchrono.org/vehicle_overview.html#vehicle_simulation_loop

每一步仿真时，依次执行：获取系统输出、同步各个系统(synchronize system)、系统动力学仿真前进一步(advance system)。

• 在各个系统同步时，可能不仅包括vehicle的模块，还包括可视化等多个模块，同时vehicle部分需要同步：驾驶控制器、地型交互、车体、可视化等模块，如有。
• 在同步之后，进行advance操作，前进一步。

正因为如此，在仿真代码中，每次loop最后会有这么两段：

// Update modules (process inputs from other modules
driver->Synchronize(time);
terrain.Synchronize(time);
hmmwv.Synchronize(time, driver_inputs, terrain);
vis->Synchronize(time, driver_inputs);
// Advance simulation for one timestep for all modules
driver->Advance(step_size);
terrain.Advance(step_size);
hmmwv.Advance(step_size);
vis->Advance(step_size);
1
2
3
4
5
6
7
8
9
10

1.3 vehicle的可视化

Vehicle的可视化与之前的整体仿真环境的可视化有些相同，但不完全相同。相同之处是，是选用irrlicht、还是OpenGL、还是离线POV-Ray可视化。我这里采用irrlicht。

除此之外，由于vehicle包括很多子模块，例如地盘、悬挂、轮胎等，在仿真时可以选择是否进行显示。一般显示方式为三种：不显示(VisualizationType::None)、显示基础结构(PRIMITIVES)、显示完整表面mesh(MESH)。例如，地盘、悬挂、转向、轮胎、外壳，全部显示MESH和只显示基础结构分别是这样的：

2. 车辆控制系统

2.1 控制系统基础概念

车辆控制系统在chrono里面称作“driver”，ChDriver。

对于车辆的控制，主要控制量只有两个：油门throttle（和刹车brake）、转向（steering 左/右）。

控制系统包括：交互控制ChIteractiveDriver、闭环控制ChClosedLoopDriver、AI Driver等多种方式，每个模块的控制代码写法不同。这里暂不展开介绍。

2.2 交互控制系统

这里采用较为简单的交互控制。交互控制通过可视化模块获取来自键盘的输入控制量，通过WSAD分别控制：加油门、刹车、左转向、右转向。需要注意，在开启交互控制前，需要按键j启动键盘控制，否则无效（注意是否关闭了中文输入法）。

交互系统部分的代码是这样的：

DriverInputs driver_inputs = driver->GetInputs();
1

之后，在调用driver->Advance函数时，即对车辆的控制量进行更新。

需要注意的是，在交互控制中，每次按键改变的是上述控制量的增量，即按一下油门，油门会增大一些。因此，并不是直接控制的速度，所以在操作时，需要练习手感。

在程序运行时，右上角会显示控制量和车辆状态：

可以看出，此时的油门是+88（油门控制量默认是0-100），刹车是0（通过按键S将油门在减为0后，刹车会上来），此时车速是8.51m/s，以及一些其他参数。

3、官方例子

这次以官方例子进行介绍：

#include "chrono/core/ChStream.h"
#include "chrono/utils/ChUtilsInputOutput.h"
#include "chrono/utils/ChFilters.h"
#include "chrono_vehicle/ChConfigVehicle.h"
#include "chrono_vehicle/ChVehicleModelData.h"
#include "chrono_vehicle/terrain/RigidTerrain.h"
#include "chrono_vehicle/output/ChVehicleOutputASCII.h"
#include "chrono_models/vehicle/hmmwv/HMMWV.h"
#include "chrono_thirdparty/filesystem/path.h"
#include "chrono_vehicle/driver/ChInteractiveDriverIRR.h"
#include "chrono_vehicle/wheeled_vehicle/ChWheeledVehicleVisualSystemIrrlicht.h"
#include <iostream>

using namespace chrono;
using namespace chrono::irrlicht;
using namespace chrono::vehicle;
using namespace chrono::vehicle::hmmwv;

// Simulation step sizes
double step_size = 1e-3;
double tire_step_size = step_size;
double t_end = 1000;

// Time interval between two render frames
double render_step_size = 1.0 / 50;  // FPS = 50

int main(int argc, char* argv[]) {
    chrono::SetChronoDataPath("E:/codeGit/chrono/chrono/build/data/");              // change the default data loading path.
    chrono::vehicle::SetDataPath("E:/codeGit/chrono/chrono/build/data/vehicle/");              // change the vehicle data path

    ChContactMethod contact_method = ChContactMethod::SMC;	// 设定碰撞类型
    // Create the HMMWV vehicle, set parameters, and initialize
    // 创建一个HMMWV车，注意如果有vehicle模块，则不需要重新定义一个物理系统，这个vehicle自带一个系统，可以直接给别的模块调用。
    HMMWV_Full hmmwv;
    hmmwv.SetCollisionSystemType(ChCollisionSystem::Type::BULLET);
    hmmwv.SetContactMethod(contact_method);
    hmmwv.SetChassisCollisionType(CollisionType::NONE);
    hmmwv.SetChassisFixed(false);
    hmmwv.SetInitPosition(ChCoordsys<>({ 0, 0, 0.5 }, { 1, 0, 0, 0 }));
    hmmwv.SetEngineType(EngineModelType::SHAFTS);
    hmmwv.SetTransmissionType(TransmissionModelType::SHAFTS);
    hmmwv.SetDriveType(DrivelineTypeWV::AWD);
    hmmwv.UseTierodBodies(true);
    hmmwv.SetSteeringType(SteeringTypeWV::PITMAN_ARM);
    hmmwv.SetBrakeType(BrakeType::SHAFTS);
    hmmwv.SetTireType(TireModelType::PAC02);
    hmmwv.SetTireStepSize(tire_step_size);
    hmmwv.Initialize();

    // Visualization type for vehicle parts (PRIMITIVES, MESH, or NONE)
    // 设置车辆各个模块的可视化程度。
    VisualizationType chassis_vis_type = VisualizationType::PRIMITIVES;
    VisualizationType suspension_vis_type = VisualizationType::PRIMITIVES;
    VisualizationType steering_vis_type = VisualizationType::PRIMITIVES;
    VisualizationType wheel_vis_type = VisualizationType::PRIMITIVES;
    VisualizationType tire_vis_type = VisualizationType::PRIMITIVES;
    hmmwv.SetChassisVisualizationType(chassis_vis_type);
    hmmwv.SetSuspensionVisualizationType(suspension_vis_type);
    hmmwv.SetSteeringVisualizationType(steering_vis_type);
    hmmwv.SetWheelVisualizationType(wheel_vis_type);
    hmmwv.SetTireVisualizationType(tire_vis_type);

    // Create the terrain 创建地形，并设置地形的一些物理参数。
    RigidTerrain terrain(hmmwv.GetSystem());
    ChContactMaterialData minfo;
    minfo.mu = 0.9f;
    minfo.cr = 0.01f;
    minfo.Y = 2e7f;
    auto patch_mat = minfo.CreateMaterial(contact_method);
    // Rigid terrain
    double terrainHeight = 0;      // terrain height (FLAT terrain only)
    double terrainLength = 200.0;  // size in X direction
    double terrainWidth = 200.0;   // size in Y direction
    std::shared_ptr<RigidTerrain::Patch> patch;
    patch = terrain.AddPatch(patch_mat, CSYSNORM, terrainLength, terrainWidth);
    patch->SetTexture(vehicle::GetDataFile("terrain/textures/dirt.jpg"), 200, 200);
    patch->SetColor(ChColor(0.8f, 0.8f, 0.5f));
    terrain.Initialize();
	
		// 创建基于irrlicht的可视化，以及交互控制系统。定义每次控制量、可hi话等内容。
    // ------------------------------------------------------------------------------
    // Create the vehicle run-time visualization interface and the interactive driver
    // ------------------------------------------------------------------------------
    // Set the time response for steering and throttle keyboard inputs.
    double steering_time = 1.0;  // time to go from 0 to +1 (or from 0 to -1)
    double throttle_time = 1.0;  // time to go from 0 to +1
    double braking_time = 0.3;   // time to go from 0 to +1

    std::shared_ptr<ChVehicleVisualSystem> vis;
    std::shared_ptr<ChDriver> driver;
    // Create the vehicle Irrlicht interface
    auto vis_irr = chrono_types::make_shared<ChWheeledVehicleVisualSystemIrrlicht>();       //~ ChWheeled这个类继承了可视化的基类
    vis_irr->SetWindowTitle("HMMWV Demo");
    vis_irr->SetChaseCamera({ 0.0, 0.0, 1.75 }, 6.0, 0.5);		// 将可视化的“相机位置”和车底盘上一点绑定。
    vis_irr->Initialize();
    vis_irr->AddLightDirectional();
    vis_irr->AddSkyBox();
    vis_irr->AddLogo();
    vis_irr->AttachVehicle(&hmmwv.GetVehicle());			// 将可视化与vehicle绑定

    // Create the interactive Irrlicht driver system  自定义每次按键的增量
    auto driver_irr = chrono_types::make_shared<ChInteractiveDriverIRR>(*vis_irr);
    driver_irr->SetSteeringDelta(render_step_size / steering_time);
    driver_irr->SetThrottleDelta(render_step_size / throttle_time);
    driver_irr->SetBrakingDelta(render_step_size / braking_time);
    driver_irr->Initialize();
    vis = vis_irr;
    driver = driver_irr;

    // ---------------
    // Simulation loop
    // ---------------
    // Number of simulation steps between miscellaneous events
    int render_steps = (int)std::ceil(render_step_size / step_size);
    // Initialize simulation frame counters
    int step_number = 0;
    int render_frame = 0;

    hmmwv.GetVehicle().EnableRealtime(true);
    while (vis->Run()) {
        double time = hmmwv.GetSystem()->GetChTime();
        // End simulation
        if (time >= t_end)
            break;
            
        // Render scene and output post-processing data
        if (step_number % render_steps == 0) {
            vis->BeginScene();
            vis->Render();
            vis->EndScene();
            render_frame++;
        }

        // Driver inputs
        DriverInputs driver_inputs = driver->GetInputs();

        // Update modules (process inputs from other modules)
        driver->Synchronize(time);
        terrain.Synchronize(time);
        hmmwv.Synchronize(time, driver_inputs, terrain);
        vis->Synchronize(time, driver_inputs);

        // Advance simulation for one timestep for all modules
        driver->Advance(step_size);
        terrain.Advance(step_size);
        hmmwv.Advance(step_size);
        vis->Advance(step_size);            //~ 更新vis的trackpoint等。

        // Increment frame number
        step_number++;
        std::cout << "Step: " << step_number << std::endl;
    }
    return 0;
	 }
}
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156

运行这个例子，就可以用WASD控制悍马车在自定义的一个地形上开动了。