modelec/detection_adversaire
1
0
Fork 0
mirror of https://github.com/modelec/detection_adversaire.git synced 2026-03-18 21:30:27 +01:00
Code Issues Packages Projects Releases Wiki Activity

Patch erreurs messages TCP

Browse Source
This commit is contained in:
Allan Cueff
2024-05-04 10:11:10 +02:00
parent 0b11f7b6de
commit e6c5f3274b
2 changed files with 20 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
src/localization.cpp
View File

@@ -17,6 +17,13 @@ void Localization::setRobotPosition(int x, int y, int alpha) {
}
void Localization::setBeaconsPosition(pair<int, int> positions[3]){
for(unsigned int i = 0; i < 3; i++){
this->beaconsPositions[i] = positions[i];
}
}
void Localization::setBeaconsMode(bool state){
this->beaconsMode = state;
}
@@ -337,14 +344,19 @@ void Localization::handleMessage(const std::string &message) {
vector<string> position = split(data, ",");
this->setRobotPosition(stoi(position[0]), stoi(position[1]), stoi(position[2]));
}
if (contains(verb, "set beacon mode")) {
//Enable or disable beacons triangulation
if (contains(verb, "set beacon")) {
//Enable or disable beacons triangulation. This must be put to 0 if no beacons are on the table
this->setBeaconsMode(stoi(data));
}
if (contains(verb, "set beacon position")) {
if (contains(verb, "set team")) {
//Update beacons position
vector<string> position = split(data, ",");
this->setRobotPosition(stoi(position[0]), stoi(position[1]), stoi(position[2]));
if(stoi(data) == 0){
pair<int, int> positions[3] = BLUE_TEAM_BEACONS_POS;
this->setBeaconsPosition(positions);
} else if(stoi(data) == 1){
pair<int, int> positions[3] = YELLOW_TEAM_BEACONS_POS;
this->setBeaconsPosition(positions);
}
}
if (contains(verb, "get pos")) {
//ONLY IF ROBOT IS STOPPED : measure robot position from multiple lidar runs.

3
src/localization.h
View File

@@ -10,6 +10,8 @@
#define AGGLOMERATES_TRIGGER 250
#define BEACONS_RADIUS 50
#define TRIANGULATION_ROUNDS 3
#define YELLOW_TEAM_BEACONS_POS {make_pair(1,2), make_pair(3,4), make_pair(5,6)}
#define BLUE_TEAM_BEACONS_POS {make_pair(1,2), make_pair(3,4), make_pair(5,6)}
#include <iostream>
#include <vector>
@@ -46,6 +48,7 @@ public:
void setLidarHealth(bool ok);
void setRobotPosition(int x, int y, int alpha);
void setBeaconsMode(bool state);
void setBeaconsPosition(pair<int, int> positions[3]);
[[nodiscard]] bool getLidarHealth() const;
[[nodiscard]] bool getBeaconsMode() const;
[[nodiscard]] vector<int> getAvoidance() const;