Smikkelbakje/J2S1-Kobuki
1
0
Fork 0
mirror of https://gitlab.fdmci.hva.nl/technische-informatica-sm3/ti-projectten/rooziinuubii79.git synced 2025-08-03 20:04:58 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

test in another branch

Browse Source
This commit is contained in:
ishak jmilou.ishak
2024-10-08 12:25:08 +02:00
parent 49dec386d7
commit ee7099654e
1 changed files with 39 additions and 40 deletions
Download Patch File Download Diff File Expand all files Collapse all files

73
src/C++/Driver/src/test.cpp
View File

@@ -1,8 +1,8 @@
#include "CKobuki.h"
#include <iostream>
#include <cmath>
#include <thread>
#include "graph.h"
#include <cmath>
#include <iostream>
#include <thread>
using namespace std;
CKobuki robot;
@@ -11,57 +11,56 @@ int command();
const int forward = 1;
const int ROTATE = 2;
int main()
{
unsigned char *null_ptr(0);
robot.startCommunication("/dev/ttyUSB0", true, null_ptr);
usleep(1 * 1000 * 1000);
thread mv(command);
usleep(30 * 1000 * 1000);
mv.join(); //only exit once thread one is done running
int main() {
unsigned char *null_ptr(0);
robot.startCommunication("/dev/ttyUSB0", true, null_ptr);
usleep(1 * 1000 * 1000);
thread mv(command);
usleep(30 * 1000 * 1000);
mv.join(); // only exit once thread one is done running
}
// int checkCenterCliff()
// {
// while (true)
// {
// std::cout << "cliffsensordata:" << robot.parser.data.CliffSensorCenter << std::endl;
// std::cout << "cliffsensordata:" <<
// robot.parser.data.CliffSensorCenter << std::endl;
// }
// }
// int checkWheelDrop(){
// while (true)
// {
// std::cout << "wheeldropdata:" << robot.parser.data.WheelDropLeft << std::endl;
// std::cout << "wheeldropdata:" << robot.parser.data.WheelDropLeft
// << std::endl;
// }
// }
int command(){
cout << "choose between forward and rotate" << endl;
cout << "What must the robot do?";
cin >> input;
int command() {
std::cout << "choose between forward and rotate" << endl;
std::cout << "What must the robot do?";
cin >> input;
switch(input){
case forward:{
int distance;
std::cout >> "Enter distance to move forward: ";
std::cin >> distance;
robot.goStraight(distance);
}
switch (input) {
case forward: {
int distance;
std::cout >> "Enter distance to move forward: ";
std::cin >> distance;
robot.goStraight(distance);
} break;
case ROTATE:{
int angle;
std::cout >> "Enter angle to rotate: ";
std::cin >> angle;
robot.doRotation(angle);
}
robot.goStraight(-1);
break;
case ROTATE: {
int angle;
std::cout >> "Enter angle to rotate: ";
std::cin >> angle;
robot.doRotation(angle);
robot.goStraight(-1);
default:
cout << "Invalid input" << endl;
break;
}
} break;
default:
cout << "Invalid input" << endl;
break;
}
}