RoboidControl/RoboidControl-cpp
RoboidControl/RoboidControl-cpp
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Bug fixes

Browse Source
This commit is contained in:
Pascal Serrarens 2023-11-16 10:43:31 +01:00
parent 48b80fb9ed
commit 1abe40815e
2 changed files with 12 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
Propulsion.cpp
View File

@ -3,6 +3,10 @@
#include "FloatSingle.h" #include "FloatSingle.h"
extern "C" {
#include "debug.h"
}
Propulsion::Propulsion() { Propulsion::Propulsion() {
this->placement = nullptr; this->placement = nullptr;
this->motorCount = 0; this->motorCount = 0;
@ -33,7 +37,7 @@ void Propulsion::AddMotors(Placement* things, unsigned int thingCount) {
} }
void Propulsion::AddQuadcopter(Quadcopter* quadcoper) { void Propulsion::AddQuadcopter(Quadcopter* quadcopter) {
this->quadcopter = quadcopter; this->quadcopter = quadcopter;
} }

8
Sensing.cpp
View File

@ -5,6 +5,10 @@
#include <math.h> #include <math.h>
#include <algorithm> #include <algorithm>
extern "C" {
#include "debug.h"
}
SensorPlacement::SensorPlacement(DistanceSensor* distanceSensor, Vector2 direction) { SensorPlacement::SensorPlacement(DistanceSensor* distanceSensor, Vector2 direction) {
this->distanceSensor = distanceSensor; this->distanceSensor = distanceSensor;
this->switchSensor = nullptr; this->switchSensor = nullptr;
@ -65,8 +69,8 @@ float Sensing::DistanceForward(float angle) {
continue; continue;
DistanceSensor* distanceSensor = (DistanceSensor*)placement.thing; DistanceSensor* distanceSensor = (DistanceSensor*)placement.thing;
float sensorAngle = placement.direction.x; float sensorAngle = placement.direction.z;
if (sensorAngle > -angle && sensorAngle < angle) { if (sensorAngle > 0 && sensorAngle < angle) {
minDistance = fmin(minDistance, distanceSensor->GetDistance()); minDistance = fmin(minDistance, distanceSensor->GetDistance());
} }
} }