roboforum.ru

Вот, собрал платформочку, начал разбираться с программированием. Столкнулся с такой проблемой:
Подключил инфракрасный дальномер GP2D1. Едет вперед, впереди стенка, лезет на стенку, а отъезжать начинает уже когда на стену лезет.
Получается, что сигнал с датчика не останавливает выполне5ние движения вперед в момент обнаружения препятствия, а срабатывает только при начале следующего цикла основной программы. Как реализовать чтоб он сразу срабатывал и отъезжать начинал?
Вот мой скетч:

/*******************************************************************************
* ROBOT
* Filename : MyRobot01.pde
********************************************************************************/
#include <AFMotor.h> // подключили библиотеку для работы с ДПТ и ШД
AF_DCMotor Motor3(3, MOTOR12_1KHZ); // используем 1-й порт на частоте ШИМ 1 кГц (можно 1,2,8,64)
AF_DCMotor Motor4(4, MOTOR12_1KHZ); // используем 2-й порт на частоте ШИМ 1 кГц (можно 1,2,8,64)
int dalnomer = 4; // дальномер
int gp2;
float distance;
// -----------------------------------------------------------------
void setup(){
Motor3.setSpeed(200); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(200); // устанавливаем скорость вращения двигателя на 2-м порту
} // end setup
// -----------------------------------------------------------------
// О С Н О В Н О Й Ц И К Л П Р О Г Р А М М Ы
void loop() {

gp2=analogRead(dalnomer);
distance=(2914/(gp2+5))-1; // Перевод в сантиметры
if (distance < 7)
{
Backward (250); delay (2000);
Spin_Right(); delay(2000);
}
// БЛУЖДАЮЩИЙ ЦИКЛ
// -----------------------------------------------------------------
Forward (250); delay(2000);
//Spin_Left(); delay(2000);
//Forward(200); delay(2000);
//Spin_Right(); delay(2000);
//Backward (150); delay(2000);
} // end loop

// ПОДПРОГРАММЫ ДВИЖЕНИЙ
// -----------------------------------------------------------------
void Forward (int speed){ // движение вперед
Motor3.setSpeed(speed); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(speed); // устанавливаем скорость вращения двигателя на 2-м порту
Motor3.run(FORWARD); // 1-й моторчик вперед крутится
Motor4.run(FORWARD); // 2-й моторчик вперед крутится
} // end Forward

void Backward (int speed){ // движение вперед
Motor3.setSpeed(speed); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(speed); // устанавливаем скорость вращения двигателя на 2-м порту
Motor3.run(BACKWARD); // 1-й моторчик назад крутится
Motor4.run(BACKWARD); // 2-й моторчик назад крутится
} // end Forward

void Release (){ // выбег с остановом
Motor3.run(RELEASE);
Motor4.run(RELEASE);
} // end Release

void Stop (){ // останов
Motor3.run(BRAKE);
Motor4.run(BRAKE);
} // end Stop

void Spin_Right (){ // поворот влево
Motor3.setSpeed(500); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(500);
Motor3.run(FORWARD); // 1-й моторчик вперед крутится
Motor4.run(BACKWARD);
delay (2000);
Motor3.run(RELEASE);
Motor4.run(RELEASE);
} // end Spin_Right

void Spin_Left (){ // поворот влево
Motor3.setSpeed(500);// устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(500);
Motor4.run(FORWARD); // 2-й моторчик вперед крутится
Motor3.run(BACKWARD);
delay (2000);
Motor3.run(RELEASE);
Motor4.run(RELEASE);
} // end Spin_Left

// -----------------------------------------------------------------

Как прервать? Нужно вводить прерывание в программу?
Если дистанция < 6см то текущее движение прерывается и разворот 2 секунды...
но как это реализовать программно? Помогите пожалуйста.

Как его сделать?

Звучит все хорошо, взглянуть бы на какой-нибудь скетч для arduino... есть у кого пример?

Вот написал цикл движения.
Вопрос теперь в том, как сделать чтобы датчик обновлял свое значение не с начала всего тела программы, а каждые 0,5 секунды???
Гуру, помогите!

void Go() { // БЛУЖДАЮЩИЙ ЦИКЛ // зациклить с условием while

gp2=analogRead(dalnomer); КАК СДЕЛАТЬ ОБНОВЛЕНИЕ ПОКАЗАНИЯ ДАТЧИКА КАЖДЫЕ 0,5 СЕКУНДЫ ЧТОБ ЭТО ВЫПОЛНЯЛОСЬ БЕСКОНЕЧНО И ПАРАЛЛЕЛЬНО ЦИКЛУ DO WHILE???
distance=(2914/(gp2+5))-1; // Перевод в сантиметры

do
{
Forward (250); delay(2000);
Spin_Left(); delay(2000);
Forward(200); delay(2000);
Spin_Right(); delay(2000);
Backward (150); delay(2000);
} while (distance > 6);
Stop (); delay (1000);
Backward (250); delay (2000);
Spin_Right(); delay(2000);
} // end loop

Сделал так: ЭФЕКТА НОЛЬ
/*******************************************************************************
* ROBOT
* Filename : MyRobot01.pde
********************************************************************************/
#include <AFMotor.h> // подключили библиотеку для работы с ДПТ и ШД
AF_DCMotor Motor3(3, MOTOR12_1KHZ); // используем 1-й порт на частоте ШИМ 1 кГц (можно 1,2,8,64)
AF_DCMotor Motor4(4, MOTOR12_1KHZ); // используем 2-й порт на частоте ШИМ 1 кГц (можно 1,2,8,64)
int dalnomer = 4; // дальномер
int gp2;
float distance;
int obstacleDetected(){
gp2=analogRead(dalnomer);
distance=(2914/(gp2+5))-1; // Перевод в сантиметры
return (distance<=6);
}


// -----------------------------------------------------------------
void setup(){
Motor3.setSpeed(200); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(200); // устанавливаем скорость вращения двигателя на 2-м порту
} // end setup
// -----------------------------------------------------------------
// О С Н О В Н О Й Ц И К Л П Р О Г Р А М М Ы
void loop(){

Go();
}
// -----------------------------------------------------------------

// -----------------------------------------------------------------
void Go() { // БЛУЖДАЮЩИЙ ЦИКЛ // зациклить с условием while

do
{
Forward (250); delay(2000);
//Spin_Left(); delay(2000);
//Forward(200); delay(2000);
Spin_Right(); delay(2000);
//Backward (150); delay(2000);
} while (obstacleDetected);
Stop (); delay (1000);
Backward (250); delay (2000);
Spin_Right(); delay(2000);
} // end loop

// ПОДПРОГРАММЫ ДВИЖЕНИЙ
// -----------------------------------------------------------------
void Forward (int speed){ // движение вперед
Motor3.setSpeed(speed); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(speed); // устанавливаем скорость вращения двигателя на 2-м порту
Motor3.run(FORWARD); // 1-й моторчик вперед крутится
Motor4.run(FORWARD); // 2-й моторчик вперед крутится
} // end Forward

void Backward (int speed){ // движение вперед
Motor3.setSpeed(speed); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(speed); // устанавливаем скорость вращения двигателя на 2-м порту
Motor3.run(BACKWARD); // 1-й моторчик назад крутится
Motor4.run(BACKWARD); // 2-й моторчик назад крутится
} // end Forward

void Release (){ // выбег с остановом
Motor3.run(RELEASE);
Motor4.run(RELEASE);
} // end Release

void Stop (){ // останов
Motor3.run(BRAKE);
Motor4.run(BRAKE);
} // end Stop

void Spin_Right (){ // поворот влево
Motor3.setSpeed(500); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(500);
Motor3.run(FORWARD); // 1-й моторчик вперед крутится
Motor4.run(BACKWARD);
delay (2000);
Motor3.run(RELEASE);
Motor4.run(RELEASE);
} // end Spin_Right

void Spin_Left (){ // поворот влево
Motor3.setSpeed(500);// устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(500);
Motor4.run(FORWARD); // 2-й моторчик вперед крутится
Motor3.run(BACKWARD);
delay (2000);
Motor3.run(RELEASE);
Motor4.run(RELEASE);
} // end Spin_Left

// -----------------------------------------------------------------

Кажется начинаю понимать... извините за тупость =(((
А можете этот скетч полностью выложить? А то я так понимаю это кусок небольшой...
Хочу более детально разобраться откуда что берется.

ВОТ мои вопросы: =)
Давайте пошагово с самого начала программы.
1)Определяем что и куда подключено
#include <AFMotor.h> // подключили библиотеку для работы с ДПТ и ШД
AF_DCMotor Motor3(3, MOTOR12_1KHZ); // используем 1-й порт на частоте ШИМ 1 кГц (можно 1,2,8,64)
AF_DCMotor Motor4(4, MOTOR12_1KHZ); // используем 2-й порт на частоте ШИМ 1 кГц (можно 1,2,8,64)
int dalnomer = 4; // дальномер
int gp2;
float distance;
int obstacleDetected(){
gp2=analogRead(dalnomer);
distance=(2914/(gp2+5))-1; // Перевод в сантиметры
return (distance<=6);

void setup(){
Motor3.setSpeed(200); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(200); // устанавливаем скорость вращения двигателя на 2-м порту
} // end setup
}

2) Пишем основной цикл: КАК ЗАМЕНИТЬ delay(2000); на шаги? Как определять шаги? Где добавить описание одного шага? Хотелось бы что-то типа Spin_Left; количество шагов
// -----------------------------------------------------------------
// О С Н О В Н О Й Ц И К Л П Р О Г Р А М М Ы
void loop(){

do
{
Forward (250); delay(2000);
//Spin_Left(); delay(2000);
//Forward(200); delay(2000);
Spin_Right(); delay(2000);
//Backward (150); delay(2000);
} while (obstacleDetected);
Stop (); delay (1000);
Backward (250); delay (2000);
Spin_Right(); delay(2000);
} // end loop

// -----------------------------------------------------------------

3) ДАЛЕЕ ПОШЛИ ПОДПРОГРАММЫ ДВИЖЕНИЙ:

// ПОДПРОГРАММЫ ДВИЖЕНИЙ ЗДЕСЬ ВСЕ ПОНЯТНО
// -----------------------------------------------------------------
void Forward (int speed){ // движение вперед
Motor3.setSpeed(speed); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(speed); // устанавливаем скорость вращения двигателя на 2-м порту
Motor3.run(FORWARD); // 1-й моторчик вперед крутится
Motor4.run(FORWARD); // 2-й моторчик вперед крутится
} // end Forward

void Backward (int speed){ // движение вперед
Motor3.setSpeed(speed); // устанавливаем скорость вращения двигателя на 1-м порту
Motor4.setSpeed(speed); // устанавливаем скорость вращения двигателя на 2-м порту
Motor3.run(BACKWARD); // 1-й моторчик назад крутится
Motor4.run(BACKWARD); // 2-й моторчик назад крутится
} // end Forward