const string bobbycar_forward = "f";
const string bobbycar_left = "l";
const string bobbycar_right = "r";
+ const string bobbycar_backward = "b";
+
+ uint8_t bobbycar_reversing = 254;
+ royale::Vector<royale::String> boobycar_reversing_script ={"s","b","b","b","b","r","b","r","b","r","b"};
public :
void naiveObstacleAvoidanceDemo()
{
+ if (bobbycar_reversing<boobycar_reversing_script.size()) {
+ std::cout << boobycar_reversing_script.at(bobbycar_reversing++) << std::endl;
+ return;
+ }
+
+
bool free_paths[num_dist_columns_];
if (naiveIsObstaclePresent(free_paths))
{
} else {
// std::cout << "STOP" << std::endl;
std::cout << bobbycar_stop << std::endl;
+ bobbycar_reversing = 0;
}
} else {
std::cout << bobbycar_forward << std::endl;
{
// if no argument was given try to open the first connected camera
royale::Vector<royale::String> camlist (manager.getConnectedCameraList());
- cout << "Detected " << camlist.size() << " camera(s)." << endl;
+ //cout << "Detected " << camlist.size() << " camera(s)." << endl;
if (!camlist.empty())
{
// set an operation mode
- if (cameraDevice->setUseCase ("MODE_5_45FPS_500") != royale::CameraStatus::SUCCESS)
+ // if (cameraDevice->setUseCase ("MODE_5_45FPS_500") != royale::CameraStatus::SUCCESS)
+ // if (cameraDevice->setUseCase ("MODE_9_10FPS_1000") != royale::CameraStatus::SUCCESS)
+ if (cameraDevice->setUseCase ("MODE_9_5FPS_2000") != royale::CameraStatus::SUCCESS)
{
cerr << "Error setting use case" << endl;
return 1;