devkit_controller.h

浏览该文件的文档.

/******************************************************************************
 * Copyright 2020 The Apollo Authors. All Rights Reserved.
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 * http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *****************************************************************************/
 
#pragma once
 
#include <memory>
#include <thread>
 
#include "modules/canbus/proto/canbus_conf.pb.h"
#include "modules/canbus/proto/vehicle_parameter.pb.h"
#include "modules/common_msgs/basic_msgs/error_code.pb.h"
#include "modules/common_msgs/chassis_msgs/chassis.pb.h"
#include "modules/common_msgs/control_msgs/control_cmd.pb.h"
 
#include "modules/canbus/vehicle/vehicle_controller.h"
#include "modules/canbus_vehicle/devkit/protocol/brake_command_101.h"
#include "modules/canbus_vehicle/devkit/protocol/gear_command_103.h"
#include "modules/canbus_vehicle/devkit/protocol/park_command_104.h"
#include "modules/canbus_vehicle/devkit/protocol/steering_command_102.h"
#include "modules/canbus_vehicle/devkit/protocol/throttle_command_100.h"
#include "modules/canbus_vehicle/devkit/protocol/vehicle_mode_command_105.h"
 
namespace apollo {
namespace canbus {
namespace devkit {
 
class DevkitController final
    : public VehicleController<::apollo::canbus::Devkit> {
 public:
  DevkitController() {}
 
  virtual ~DevkitController();
 
  ::apollo::common::ErrorCode Init(
      const VehicleParameter& params,
      CanSender<::apollo::canbus::Devkit>* const can_sender,
      MessageManager<::apollo::canbus::Devkit>* const message_manager) override;
 
  bool Start() override;
 
  void Stop() override;
 
  Chassis chassis() override;
 
  void AddSendMessage() override;
 
  FRIEND_TEST(DevkitControllerTest, SetDrivingMode);
  FRIEND_TEST(DevkitControllerTest, Status);
  FRIEND_TEST(DevkitControllerTest, UpdateDrivingMode);
 
 private:
  // main logical function for operation the car enter or exit the auto driving
  void Emergency() override;
  ::apollo::common::ErrorCode EnableAutoMode() override;
  ::apollo::common::ErrorCode DisableAutoMode() override;
  ::apollo::common::ErrorCode EnableSteeringOnlyMode() override;
  ::apollo::common::ErrorCode EnableSpeedOnlyMode() override;
 
  // NEUTRAL, REVERSE, DRIVE
  void Gear(Chassis::GearPosition state) override;
 
  // brake with new acceleration
  // acceleration:0.00~99.99, unit:
  // acceleration_spd: 60 ~ 100, suggest: 90
  void Brake(double acceleration) override;
 
  // drive with old acceleration
  // gas:0.00~99.99 unit:
  void Throttle(double throttle) override;
 
  // drive with acceleration/deceleration
  // acc:-7.0~5.0 unit:m/s^2
  void Acceleration(double acc) override;
 
  // drive with speed
  // speed:-xx.0~xx.0 unit:m/s
  void Speed(double speed);
 
  // steering with old angle speed
  // angle:-99.99~0.00~99.99, unit:, left:+, right:-
  void Steer(double angle) override;
 
  // steering with new angle speed
  // angle:-99.99~0.00~99.99, unit:, left:+, right:-
  // angle_spd:0.00~99.99, unit:deg/s
  void Steer(double angle, double angle_spd) override;
 
  // set Electrical Park Brake
  void SetEpbBreak(const control::ControlCommand& command) override;
  common::ErrorCode HandleCustomOperation(
      const external_command::ChassisCommand& command) override;
  void SetBeam(const common::VehicleSignal& signal) override;
  void SetHorn(const common::VehicleSignal& signal) override;
  void SetTurningSignal(const common::VehicleSignal& signal) override;
 
  // response vid
  bool VerifyID() override;
  void ResetProtocol();
  bool CheckChassisError();
  bool CheckVin();
  void GetVin();
  void ResetVin();
 
 private:
  void SecurityDogThreadFunc();
  virtual bool CheckResponse(const int32_t flags, bool need_wait);
  void set_chassis_error_mask(const int32_t mask);
  int32_t chassis_error_mask();
  Chassis::ErrorCode chassis_error_code();
  void set_chassis_error_code(const Chassis::ErrorCode& error_code);
 
 private:
  // control protocol
  Brakecommand101* brake_command_101_ = nullptr;
  Gearcommand103* gear_command_103_ = nullptr;
  Parkcommand104* park_command_104_ = nullptr;
  Steeringcommand102* steering_command_102_ = nullptr;
  Throttlecommand100* throttle_command_100_ = nullptr;
  Vehiclemodecommand105* vehicle_mode_command_105_ = nullptr;
 
  Chassis chassis_;
  std::unique_ptr<std::thread> thread_;
  bool is_chassis_error_ = false;
 
  std::mutex chassis_error_code_mutex_;
  Chassis::ErrorCode chassis_error_code_ = Chassis::NO_ERROR;
 
  std::mutex chassis_mask_mutex_;
  int32_t chassis_error_mask_ = 0;
};
 
}  // namespace devkit
}  // namespace canbus
}  // namespace apollo