void resumeDriving(int16_t len) {
#ifdef MAPPINGCONTROLLER_DEBUG
	printf("Waiting 500ms before continuing\r\n");
	os_wait(500);
	printf("Resuming driving %d\r\n", len);
#endif

	// drive straight ahead to avoid edges
	drive_setSteeringAngleBalanced(0);
	driveLen(len);

	// restart CrossingAnalyzer and WallFollow
	startCrossingAnalyzer();
	startWallFollow(2, 0);
}
void MainWindow::connectActions()
{
    this->connect(ui->PBStart,SIGNAL(clicked()),this,SLOT(startWallFollow()));
}