vita.aeterna/Robotino
1
0
Fork 0
mirror of https://github.com/VitaAetaerna/Robotino.git synced 2025-01-18 06:51:35 +01:00
Code Issues Packages Projects Releases Wiki Activity

Delete TraffixLightArray

Browse Source
This commit is contained in:
Vita Aeterna 2023-01-30 16:02:14 +01:00 committed by GitHub
parent 589c89eceb
commit 4119ce1f3d
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 0 additions and 201 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

201
TraffixLightArray
View File

@ -1,201 +0,0 @@
#include <iostream>
#include <stdlib.h>
#include "rec/robotino/api2/all.h"
#include <iostream>
using namespace rec::robotino::api2;
using namespace std;
bool _run = true;
class MyCom : public Com
{
public:
MyCom()
: Com( "TrafficLight" )
{
}
void errorEvent( const char* errorString )
{
std::cerr << "Error: " << errorString << std::endl;
}
void connectedEvent()
{
std::cout << "Connected." << std::endl;
}
void connectionClosedEvent()
{
std::cout << "Connection closed." << std::endl;
}
void logEvent( const char* message, int level )
{
std::cout << message << std::endl;
}
};
class MyBumper : public Bumper
{
public:
MyBumper()
: bumped( false )
{
}
void bumperEvent( bool hasContact )
{
bumped |= hasContact;
if (true == bumped){
std::cout << "Bumper has " << ( hasContact ? "contact" : "no contact") << std::endl;
}
}
bool bumped;
};
double x_distance = 0;
double y_distance = 0;
int phi_absolute = 0;
unsigned int sequence = 0;
int digital_inputs[8] = {0,0,0,0,0,0,0,0};
int digital_outputs[8] = {1,1,1,1,1,1,1,1};
class MyOdometry: public Odometry{
void readingsEvent(double x,double y, double phi, float vx, float vy, float omega, unsigned int seq ){
// cout << "X: " << x << " Y: " << y << " Richtung: " << phi << " Sequenz: " << seq << endl;
x_distance = x;
y_distance = y;
phi_absolute = phi;
sequence = seq;
}
};
class MyDigitalInputArray: public DigitalInputArray{
void valuesChangedEvent(const int *value, unsigned int size){
for (int i=0; i<size; i++){
digital_inputs[i] = value[i];
}
cout << *value;
}
};
MyCom com;
MyBumper bumper;
OmniDrive omniDrive;
MyOdometry odo;
MyDigitalInputArray mydia;
DigitalOutputArray myout;
void init( const std::string& hostname )
{
// Connect
std::cout << "Connecting...";
com.setAddress( hostname.c_str() );
com.connectToServer( true );
if( false == com.isConnected() )
{
std::cout << std::endl << "Could not connect to " << com.address() << std::endl;
rec::robotino::api2::shutdown();
exit( 1 );
}
else
{
std::cout << "success" << std::endl;
}
}
void drive()
{
odo.set(0,0,0,-1);
while( com.isConnected() && false == bumper.value() && _run )
{
rec::robotino::api2::msleep(100);
DigitalInput();
com.processEvents();
rec::robotino::api2::msleep(100);
}
}
int main( int argc, char **argv )
{
std::string hostname = "192.168.100.174";
if( argc > 1 )
{
hostname = argv[1];
}
//main program routine starts in here
try
{
//connect to your robotino (or try at least)
init( hostname );
//drive (this contains a while loop)
while(true){
myout.setValues(digital_outputs, 8);
for (int i=0; i<8; i++){
digital_outputs[i] = ! digital_outputs[i];
}
rec::robotino::api2::msleep(1000);
}
//drive();
//exit
com.disconnectFromServer();
}
catch( const rec::robotino::api2::RobotinoException& e )
{
std::cerr << "Com Error: " << e.what() << std::endl;
}
catch( const std::exception& e )
{
std::cerr << "Error: " << e.what() << std::endl;
}
catch( ... )
{
std::cerr << "Unknow Error" << std::endl;
}
rec::robotino::api2::shutdown();
#ifdef WIN32
std::cout << "Press any key to exit..." << std::endl;
rec::robotino::api2::waitForKey();
#endif
}