34 {
35 const auto& planning_command = frame->local_view().planning_command;
36
37 if (!planning_command->has_header() || !planning_command->header().has_sequence_num()
38 || planning_command->header().sequence_num() == last_sequence_num_) {
39
40 if (last_cruise_speed_ > 0.0) {
41 reference_line_info->SetCruiseSpeed(last_cruise_speed_);
42 }
44 }
45
46
47 if (planning_command->is_motion_command()) {
48 last_cruise_speed_ = reference_line_info->GetBaseCruiseSpeed();
50 }
51
52
53 if (!planning_command->has_custom_command()
54 || !planning_command->custom_command().Is<external_command::SpeedCommand>()) {
55
56 if (last_cruise_speed_ > 0.0) {
57 reference_line_info->SetCruiseSpeed(last_cruise_speed_);
58 }
60 }
61 const auto& custom_command = planning_command->custom_command();
62 external_command::SpeedCommand speed_command;
63 if (!custom_command.UnpackTo(&speed_command)) {
64
65 if (last_cruise_speed_ > 0.0) {
66 reference_line_info->SetCruiseSpeed(last_cruise_speed_);
67 }
68 AERROR <<
"Unpack speed command failed!";
70 }
71
72
73 if (speed_command.has_is_restore_target_speed() && speed_command.is_restore_target_speed()) {
74 last_cruise_speed_ = reference_line_info->GetBaseCruiseSpeed();
76 }
77 last_sequence_num_ = planning_command->header().sequence_num();
78
79 if (last_cruise_speed_ < 0.0) {
80 last_cruise_speed_ = reference_line_info->GetBaseCruiseSpeed();
81 }
82
83 if (speed_command.has_target_speed()) {
84 reference_line_info->SetCruiseSpeed(speed_command.target_speed());
85 } else if (speed_command.has_target_speed_factor()) {
86
87 double target_speed = last_cruise_speed_ * speed_command.target_speed_factor();
88 reference_line_info->SetCruiseSpeed(target_speed);
89 }
90 last_cruise_speed_ = reference_line_info->GetBaseCruiseSpeed();
92}
static Status OK()
generate a success status.