Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_RobotisServo: move serial port init of RobotisServo protocol into RobotisServo library

This commit is contained in:
Peter Barker 2023-09-26 08:05:51 +10:00
parent 94380eb9be
commit 9e16112e7f
2 changed files with 11 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
libraries/AP_RobotisServo/AP_RobotisServo.cpp
View File

@ -138,11 +138,18 @@ void AP_RobotisServo::init(void)
{
AP_SerialManager &serial_manager = AP::serialmanager();
port = serial_manager.find_serial(AP_SerialManager::SerialProtocol_Robotis,0);
if (port) {
baudrate = serial_manager.find_baudrate(AP_SerialManager::SerialProtocol_Robotis, 0);
us_per_byte = 10 * 1e6 / baudrate;
us_gap = 4 * 1e6 / baudrate;
if (port == nullptr) {
return;
}
const uint32_t baudrate = serial_manager.find_baudrate(AP_SerialManager::SerialProtocol_Robotis, 0);
port->begin(baudrate, 128, 128);
port->set_unbuffered_writes(true);
port->set_flow_control(AP_HAL::UARTDriver::FLOW_CONTROL_DISABLE);
us_per_byte = 10 * 1e6 / baudrate;
us_gap = 4 * 1e6 / baudrate;
}
/*

1
libraries/AP_RobotisServo/AP_RobotisServo.h
View File

@ -42,7 +42,6 @@ public:
private:
AP_HAL::UARTDriver *port;
uint32_t baudrate;
uint32_t us_per_byte;
uint32_t us_gap;