put movement in its own function

This commit is contained in:
2024-09-23 13:54:07 +02:00
parent 0db8ab3e2f
commit efa0692128

View File

@@ -1,37 +1,53 @@
#include "CKobuki.h"
#include <iostream>
#include <cmath>
#include <thread>
#include "graph.h"
using namespace std;
CKobuki robot;
int movement();
int main() {
unsigned char * null_ptr(0);
int text;
int main()
{
unsigned char *null_ptr(0);
robot.startCommunication("/dev/ttyUSB0", true, null_ptr);
usleep(1*1000*1000);
usleep(1 * 1000 * 1000);
cout << "Enter commando";
cin >> text;
if (text == 1) {
usleep(30 * 1000 * 1000);
thread mv(movement);
}
int checkCenterCliff()
{
while (true)
{
std::cout << "cliffsensordata:" << robot.data.CliffSensorCenter << std::endl;
}
}
int movement()
{
int text;
while (true)
{
cin >> text;
if (text == 1)
{
robot.goStraight(10);
}
if (text == 2) {
robot.doRotation(90);
}
if (text == 3) {
robot.doRotation(90);
}
else {
cout << "no text specified";
}
usleep(30*1000*1000);
}
int checkCenterCliff() {
while(true) {
std::cout << "cliffsensordata:" << robot.data.CliffSensorCenter << std::endl;
}
if (text == 2)
{
robot.doRotation(90);
}
if (text == 3)
{
robot.doRotation(90);
}
else
{
cout << "no text specified";
}
}
}