-
Notifications
You must be signed in to change notification settings - Fork 1.2k
/
solar_system_run_dynamics.cc
57 lines (42 loc) · 1.57 KB
/
solar_system_run_dynamics.cc
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
#include <gflags/gflags.h>
#include "drake/examples/scene_graph/solar_system.h"
#include "drake/geometry/drake_visualizer.h"
#include "drake/geometry/scene_graph.h"
#include "drake/lcm/drake_lcm.h"
#include "drake/systems/analysis/simulator.h"
#include "drake/systems/framework/diagram_builder.h"
DEFINE_double(simulation_time, 13.0,
"Desired duration of the simulation in seconds.");
namespace drake {
namespace examples {
namespace solar_system {
namespace {
using geometry::SceneGraph;
using geometry::SourceId;
using lcm::DrakeLcm;
int do_main() {
systems::DiagramBuilder<double> builder;
auto scene_graph = builder.AddSystem<SceneGraph<double>>();
scene_graph->set_name("scene_graph");
auto solar_system = builder.AddSystem<SolarSystem>(scene_graph);
solar_system->set_name("SolarSystem");
builder.Connect(solar_system->get_geometry_pose_output_port(),
scene_graph->get_source_pose_port(solar_system->source_id()));
geometry::DrakeVisualizerd::AddToBuilder(&builder, *scene_graph);
auto diagram = builder.Build();
systems::Simulator<double> simulator(*diagram);
simulator.get_mutable_integrator().set_maximum_step_size(0.002);
simulator.set_publish_every_time_step(false);
simulator.set_target_realtime_rate(1);
simulator.Initialize();
simulator.AdvanceTo(FLAGS_simulation_time);
return 0;
}
} // namespace
} // namespace solar_system
} // namespace examples
} // namespace drake
int main(int argc, char* argv[]) {
gflags::ParseCommandLineFlags(&argc, &argv, true);
return drake::examples::solar_system::do_main();
}