test in another branch

This commit is contained in:
ishak jmilou.ishak
2024-10-08 12:25:08 +02:00
parent 49dec386d7
commit ee7099654e

View File

@@ -1,8 +1,8 @@
#include "CKobuki.h" #include "CKobuki.h"
#include <iostream>
#include <cmath>
#include <thread>
#include "graph.h" #include "graph.h"
#include <cmath>
#include <iostream>
#include <thread>
using namespace std; using namespace std;
CKobuki robot; CKobuki robot;
@@ -11,8 +11,7 @@ int command();
const int forward = 1; const int forward = 1;
const int ROTATE = 2; const int ROTATE = 2;
int main() int main() {
{
unsigned char *null_ptr(0); unsigned char *null_ptr(0);
robot.startCommunication("/dev/ttyUSB0", true, null_ptr); robot.startCommunication("/dev/ttyUSB0", true, null_ptr);
usleep(1 * 1000 * 1000); usleep(1 * 1000 * 1000);
@@ -25,20 +24,22 @@ int main()
// { // {
// while (true) // while (true)
// { // {
// std::cout << "cliffsensordata:" << robot.parser.data.CliffSensorCenter << std::endl; // std::cout << "cliffsensordata:" <<
// robot.parser.data.CliffSensorCenter << std::endl;
// } // }
// } // }
// int checkWheelDrop(){ // int checkWheelDrop(){
// while (true) // while (true)
// { // {
// std::cout << "wheeldropdata:" << robot.parser.data.WheelDropLeft << std::endl; // std::cout << "wheeldropdata:" << robot.parser.data.WheelDropLeft
// << std::endl;
// } // }
// } // }
int command() { int command() {
cout << "choose between forward and rotate" << endl; std::cout << "choose between forward and rotate" << endl;
cout << "What must the robot do?"; std::cout << "What must the robot do?";
cin >> input; cin >> input;
switch (input) { switch (input) {
@@ -47,21 +48,19 @@ int command(){
std::cout >> "Enter distance to move forward: "; std::cout >> "Enter distance to move forward: ";
std::cin >> distance; std::cin >> distance;
robot.goStraight(distance); robot.goStraight(distance);
} } break;
case ROTATE: { case ROTATE: {
int angle; int angle;
std::cout >> "Enter angle to rotate: "; std::cout >> "Enter angle to rotate: ";
std::cin >> angle; std::cin >> angle;
robot.doRotation(angle); robot.doRotation(angle);
}
robot.goStraight(-1); robot.goStraight(-1);
break;
} break;
default: default:
cout << "Invalid input" << endl; cout << "Invalid input" << endl;
break; break;
} }
} }