mirrors/ugv_sdk
1
0
Fork 0
mirror of https://github.com/westonrobot/ugv_sdk synced 2023-04-08 06:32:14 +08:00
Code Issues Packages Projects Releases Wiki Activity

scout mini works

Browse Source
This commit is contained in:
Ruixiang Du
2021-07-13 18:58:54 +08:00
parent 3d86c9548c
commit ce8d9a6e66
5 changed files with 30 additions and 19 deletions
Download Patch File Download Diff File Expand all files Collapse all files

23
demo/scout_demo/scout_robot_demo.cpp
View File

@@ -34,11 +34,11 @@ int main(int argc, char **argv) {
std::unique_ptr<ScoutRobot> scout;
if (protocol_version == "v1") {
scout =
std::unique_ptr<ScoutRobot>(new ScoutRobot(ProtocolVersion::AGX_V1));
scout = std::unique_ptr<ScoutRobot>(
new ScoutRobot(ProtocolVersion::AGX_V1, true));
} else if (protocol_version == "v2") {
scout =
std::unique_ptr<ScoutRobot>(new ScoutRobot(ProtocolVersion::AGX_V2));
scout = std::unique_ptr<ScoutRobot>(
new ScoutRobot(ProtocolVersion::AGX_V2, true));
} else {
std::cout << "Error: invalid protocol version string" << std::endl;
return -1;
@@ -66,19 +66,18 @@ int main(int argc, char **argv) {
std::cout << "Light: breath" << std::endl;
scout->SetLightCommand(BREATH, 0, BREATH, 0);
sleep(3);
std::cout << "Light: custom 90-80" << std::endl;
scout->SetLightCommand(CUSTOM, 90, CUSTOM, 80);
std::cout << "Light: custom 30-80" << std::endl;
scout->SetLightCommand(CUSTOM, 30, CUSTOM, 80);
sleep(3);
std::cout << "Light: diabled cmd control" << std::endl;
scout->DisableLightControl();
// std::cout << "Light: diabled cmd control" << std::endl;
// scout->DisableLightControl();
scout->SetLightCommand(CONST_OFF, 0, CONST_OFF, 0);
int count = 0;
while (true) {
// motion control
// if (count < 100) {
std::cout << "Motor: 0.2, 0" << std::endl;
scout->SetMotionCommand(0.2, 0.0);
// }
std::cout << "Motor: 1.0, 0" << std::endl;
scout->SetMotionCommand(1.0, 0.0);
// get robot state
auto state = scout->GetRobotState();

2
include/ugv_sdk/details/protocol_v1/protocol_v1_parser.hpp
View File

@@ -61,7 +61,7 @@ class ProtocolV1Parser : public ParserInterface<ProtocolVersion::AGX_V1> {
};
using ScoutProtocolV1Parser = ProtocolV1Parser<ScoutV2Limits>;
using ScoutMiniProtocolV1Parser = ProtocolV1Parser<ScoutV2Limits>;
using ScoutMiniProtocolV1Parser = ProtocolV1Parser<ScoutMiniLimits>;
using HunterProtocolV1Parser = ProtocolV1Parser<HunterV1Limits>;

3
include/ugv_sdk/details/robot_base/scout_base.hpp
View File

@@ -125,7 +125,10 @@ class ScoutBase : public AgilexBase<Parser>, public ScoutInterface {
namespace westonrobot {
using ScoutBaseV1 = ScoutBase<ScoutProtocolV1Parser>;
using ScoutMiniBaseV1 = ScoutBase<ScoutMiniProtocolV1Parser>;
using ScoutBaseV2 = ScoutBase<ProtocolV2Parser>;
using ScoutMiniBaseV2 = ScoutBase<ProtocolV2Parser>;
} // namespace westonrobot
#endif /* SCOUT_BASE_HPP */

3
include/ugv_sdk/mobile_robot/scout_robot.hpp
View File

@@ -18,7 +18,8 @@
namespace westonrobot {
class ScoutRobot : public RobotInterface, public ScoutInterface {
public:
ScoutRobot(ProtocolVersion protocol = ProtocolVersion::AGX_V2);
ScoutRobot(ProtocolVersion protocol = ProtocolVersion::AGX_V2,
bool is_mini_model = false);
~ScoutRobot();
void Connect(std::string can_name) override;

10
src/mobile_robot/scout_robot.cpp
View File

@@ -11,12 +11,20 @@
#include "ugv_sdk/details/robot_base/scout_base.hpp"
namespace westonrobot {
ScoutRobot::ScoutRobot(ProtocolVersion protocol) {
ScoutRobot::ScoutRobot(ProtocolVersion protocol, bool is_mini_model) {
if (!is_mini_model) {
if (protocol == ProtocolVersion::AGX_V1) {
robot_ = new ScoutBaseV1();
} else if (protocol == ProtocolVersion::AGX_V2) {
robot_ = new ScoutBaseV2();
}
} else {
if (protocol == ProtocolVersion::AGX_V1) {
robot_ = new ScoutMiniBaseV1();
} else if (protocol == ProtocolVersion::AGX_V2) {
robot_ = new ScoutMiniBaseV2();
}
}
}
ScoutRobot::~ScoutRobot() {