yasarba71520/Line-Following-Robot
2
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

motor signals in the loop

Browse Source
This commit is contained in:
Tim Zeuner 2023-01-04 21:50:59 +01:00
parent 747053f132
commit 7175b68abe
3 changed files with 7 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
AutonomousMode/autonomous_mode_main.cpp
View File

@ -40,7 +40,9 @@ int main(void)
double delta = static_cast<double>(deltaMs) / 1000.0;
double frameRate = 1.0 / static_cast<double>(delta);
std::cout << "Frame rate: " << frameRate << std::endl;
std::cout << "Frame rate: " << frameRate << " angle: " << result.data.angle
<< " motor 1: " << result.motorSignals[0] << " motor 2: " << result.motorSignals[1]
<< " motor 3: " << result.motorSignals[2] << " motor 4: " << result.motorSignals[3] <<std::endl;
last = now;
}
}, &mutex);

3
AutonomousMode/lfr.cpp
View File

@ -67,12 +67,15 @@ void LFR::createThread()
FrameData data = processing.calculateLineSegments(processedImage, roi);
processing.filterReflections(data);
processing.calcAngles(data, originalImage.cols, originalImage.rows, left);
controlModule.calcSpeeds(1,1, data.angle);
processedImage = provideOutput(originalImage, processedImage, data, roi);
result.rawImage = originalImage;
result.processedImage = processedImage;
result.data = data;
result.motorSignals = controlModule.readMotors();
}
catch(std::exception const &ex)
{

1
AutonomousMode/lfr.h
View File

@ -21,6 +21,7 @@ struct LFR_Result
cv::Mat rawImage;
cv::Mat processedImage;
FrameData data;
std::vector<float> motorSignals;
};
class LFR