Дан шаблон программы: // библиотеки не нужны #define k xx //xx - число измерений по…
- User
Дан шаблон программы: // библиотеки не нужны #define k xx //xx - число измерений по варианту volatile long duration, cm, L; int counter, err; /////////////////////////////////////////////// ISR(INTx_vect)//обработчик прерывания INTx (x=0-1) {// прерывание сработает по любому фронту – 2 раза if (высокий уровень на INTx) // сброс таймера else duration=???; // взять с таймера } ///////////////////////////////////////////// void setup() { /* Инициализируем взаимодействие по последовательному порту / Serial.begin (9600); //Определяем вводы и выводы DDRx=yy; // Настройка таймера T1 на частоту 2 МГц TCCR1A=aa; TCCR1B=bb; TCCR1C=cc; // Настройка прерывания INTx на «Любой фронт» EICRA=dd; EIMSK=ee; sei(); } void loop() { //настройка процесса усреднения результатов counter=1; cm=0; while (counter<=k){ // цикл до числа усреднений / Генерирование короткого импульса длительностью 10 микросекунд. _|–––| :)/ PORTx=xx; delayMicroseconds(10); PORTx=xx; err=0; // сброс флага ошибки TCNT1=0;// сброс счетного регистра // ждем задний фронт ответного импульса на ECHO: duration=0; while(!duration){if(TCNT1>65500) {err=1; break;} } /duration должен обновиться в прерывании по заднему фронту – этого и ждем/ cm = cm + ???;// накопление результата измерений counter++; } 13 L = cm/+-???;// Усреднений результатов // Преобразование времени в расстояние ////////////////////////////////////////////////// /* Вывод расстояния до препятствия в заданных единицах Вывод состояния ошибки*/ ////////////////////////////////////////////////// // Задержка между измерениями для корректной работы датчика delay(250); }
- Assistant
Предлагаю заполнить шаблон программы для работы с ультразвуковым датчиком расстояния (например, HC-SR04). В данной программе мы используем прерывания для определения времени, прошедшего от отправки ультразвукового сигнала до получения его отражения.
Поскольку код требует заполнения конкретных значений, я выберу стандартные конфигурации, но вы сможете адаптировать их под ваше устройство и задачи.
#define k 5 // Число измерений для усреднения volatile long duration = 0, cm = 0, L = 0; int counter, err; /////////////////////////////////////////////// ISR(INT0_vect) // Обработчик прерывания INT0 { if (PIND & (1 << PIND2)) { // Если высокий уровень на INT0 (ECHO) TCNT1 = 0; // Сброс таймера } else { duration = TCNT1; // Считывание времени с таймера } } ///////////////////////////////////////////// void setup() { Serial.begin(9600); // Инициализация последовательного порта DDRB |= (1 << DDB5); // Установка пина для TRIG как выход DDRE &= ~(1 << DDE2); // Установка пина для ECHO как вход // Настройка таймера T1 на частоту 2 МГц TCCR1A = 0; // Режим обычной работы TCCR1B = (1 << CS10); // Установка делителя CLK/1 для 2 МГц (при 16 МГц) TCCR1C = 0; // Настройка прерывания INT0 на «Любой фронт» (нараст.) EICRA = (1 << ISC00); // ICP0, на любое изменение; ISC01 – нарастающий (по желанию) EIMSK = (1 << INT0); // Включаем прерывание INT0 sei(); // Глобальное включение прерываний } void loop() { // Настройка процесса усреднения результатов counter = 1; cm = 0; while (counter <= k) { // Цикл до числа усреднений // Генерирование короткого импульса длительностью 10 микросекунд PORTB |= (1 << PORTB5); // Устанавливаем TRIG в HIGH delayMicroseconds(10); PORTB &= ~(1 << PORTB5); // Устанавливаем TRIG в LOW err = 0; // Сброс флага ошибки TCNT1 = 0; // Сброс счетного регистра // Ждем задний фронт ответного импульса на ECHO: duration = 0; while (!duration) { if (TCNT1 > 65500) { // Проверка на переполнение таймера err = 1; break; } } // Преобразование счета таймера в длину (duration в микросекундах) cm += duration * 0.034 / 2; // Зависимость расстояния от времени при скорости звука (343 м/с) counter++; } L = cm / k; // Усреднение результатов // Вывод результатов Serial.print("Distance: "); Serial.print(L); Serial.println(" cm"); // Вывод состояния ошибки if (err) { Serial.println("Error: Measurement Timeout"); } // Задержка между измерениями для корректной работы датчика delay(250); }Объяснение заполненных полей:
#define k 5: Устанавливает количество измерений для усреднения.ISR(INT0_vect): Обработчик прерывания. Если уровень наECHOвысокий, обнуляется таймер, иначе считывается значение времени от последней обнуления.TCCR1B = (1 << CS10): Настройка таймера с предделителем1, что при 16 МГц даст частоту таймера2 МГц.- В основном цикле программы генерируется короткий импульс, после чего в цикле ожидается завершение измерения с использованием прерывания.
- Расстояние до препятствия рассчитывается как
cm += duration * 0.034 / 2;, поскольку звук проходит туда и обратно.
Убедитесь, что вы правильно установили порты и пины, которые используете!
- User
Код рабочий, но теперь он выдает ошибку при расстоянии больше 1 метра. Нужно сделать чтобы он работал до 5 метров минимум
- Assistant
Чтобы увеличить дальность измерения до 5 метров, потребуется немного отредактировать расчёт расстояния и добавить проверку на возможные ошибки, связанные с превышением максимальной дистанции, что обычно происходит, когда
durationпревышает определённое значение.Такой подход будет включать следующие изменения:
- Удостоверимся, что значение времени, которое соответствует максимальному расстоянию, правильно вычисляется.
- Добавим проверку длительности
duration, чтобы убедиться, что она не превышает максимальную продолжительность, соответствующую 5 метрам.
Измененный код:
#define k 5 // Число измерений для усреднения #define MAX_DISTANCE 500 // Максимальное расстояние в сантиметрах для проверки #define SOUND_SPEED 0.034 // Скорость звука в см/мкc volatile long duration = 0, cm = 0, L = 0; int counter, err; /////////////////////////////////////////////// ISR(INT0_vect) // Обработчик прерывания INT0 { if (PIND & (1 << PIND2)) { // Если высокий уровень на INT0 (ECHO) TCNT1 = 0; // Сброс таймера } else { duration = TCNT1; // Считывание времени с таймера } } ///////////////////////////////////////////// void setup() { Serial.begin(9600); // Инициализация последовательного порта DDRB |= (1 << DDB5); // Установка пина для TRIG как выход DDRE &= ~(1 << DDE2); // Установка пина для ECHO как вход // Настройка таймера T1 на частоту 2 МГц TCCR1A = 0; // Режим обычной работы TCCR1B = (1 << CS10); // Установка делителя CLK/1 для 2 МГц (при 16 МГц) TCCR1C = 0; // Настройка прерывания INT0 на «Любой фронт» (нараст.) EICRA = (1 << ISC00); // ICP0, на любое изменение EIMSK = (1 << INT0); // Включаем прерывание INT0 sei(); // Глобальное включение прерываний } void loop() { // Настройка процесса усреднения результатов counter = 1; cm = 0; while (counter <= k) { // Цикл до числа усреднений // Генерирование короткого импульса длительностью 10 микросекунд PORTB |= (1 << PORTB5); // Устанавливаем TRIG в HIGH delayMicroseconds(10); PORTB &= ~(1 << PORTB5); // Устанавливаем TRIG в LOW err = 0; // Сброс флага ошибки TCNT1 = 0; // Сброс счетного регистра // Ждем задний фронт ответного импульса на ECHO: duration = 0; while (!duration) { if (TCNT1 > 65500) { // Проверка на переполнение таймера err = 1; break; } } // Преобразование счета таймера в длину (duration в микросекундах) // Проверка, что duration не превышает соответствующее время для 5 метров if (duration * SOUND_SPEED / 2 <= MAX_DISTANCE) { cm += duration * SOUND_SPEED / 2; // Зависимость расстояния от времени при скорости звука } else { err = 1; // Ошибка, если расстояние превышает максимальное } counter++; } L = cm / k; // Усреднение результатов // Вывод результатов Serial.print("Distance: "); Serial.print(L); Serial.println(" cm"); // Вывод состояния ошибки if (err) { Serial.println("Error: Measurement Timeout or Out of Range"); } // Задержка между измерениями для корректной работы датчика delay(250); }Изменения в коде:
- Определение максимального расстояния: Мы задали
#define MAX_DISTANCE 500, чтобы проверить, соответствует ли измеренныйdurationрасстоянию до 5 метров. - Проверка
duration: Перед накоплением значений расстояний добавили проверкуif (duration * SOUND_SPEED / 2 <= MAX_DISTANCE)для подтверждения, что расстояние не превышает 5 метров. - Если измерение превышает 5 метров, устанавливается флаг ошибки.
Убедитесь в том, что все элементы системы, такие как датчик и его подключение, работают нормально, так как измерения могут варьироваться из-за шумов или неправильных подключений.
- User
Сделай этот код для значений: количество измерений: 6, вывод на Trig:PB1, вывод на Echo:INT1, формат измерения: см
- Assistant
Вот обновлённый код, соответствующий вашим требованиям: количество измерений установлено на 6, вывод Trig на
PB1, а Echo наINT1. При этом значения будут выводиться в сантиметрах.Изменённый код:
#define k 6 // Количество измерений для усреднения #define MAX_DISTANCE 500 // Максимальное расстояние в сантиметрах #define SOUND_SPEED 0.034 // Скорость звука в см/мкc volatile long duration = 0, cm = 0, L = 0; int counter, err; /////////////////////////////////////////////// ISR(INT1_vect) // Обработчик прерывания INT1 { if (PIND & (1 << PIND3)) { // Если высокий уровень на INT1 (ECHO) TCNT1 = 0; // Сброс таймера } else { duration = TCNT1; // Считывание времени с таймера } } ///////////////////////////////////////////// void setup() { Serial.begin(9600); // Инициализация последовательного порта DDRB |= (1 << DDB1); // Установка пина для TRIG (PB1) как выход DDRE &= ~(1 << DDE3); // Установка пина для ECHO (INT1) как вход // Настройка таймера T1 на частоту 2 МГц TCCR1A = 0; // Режим обычной работы TCCR1B = (1 << CS10); // Установка делителя CLK/1 для 2 МГц (при 16 МГц) TCCR1C = 0; // Настройка прерывания INT1 на «Любой фронт» (нараст. и спад.) EICRA = (1 << ISC10) | (1 << ISC11); // ICP1, на любое изменение EIMSK = (1 << INT1); // Включаем прерывание INT1 sei(); // Глобальное включение прерываний } void loop() { // Настройка процесса усреднения результатов counter = 1; cm = 0; while (counter <= k) { // Цикл до числа усреднений // Генерирование короткого импульса длительностью 10 микросекунд PORTB |= (1 << PORTB1); // Устанавливаем TRIG в HIGH (PB1) delayMicroseconds(10); PORTB &= ~(1 << PORTB1); // Устанавливаем TRIG в LOW err = 0; // Сброс флага ошибки TCNT1 = 0; // Сброс счетного регистра // Ждем задний фронт ответного импульса на ECHO: duration = 0; while (!duration) { if (TCNT1 > 65500) { // Проверка на переполнение таймера err = 1; break; } } // Проверка, что duration не превышает время, соответствующее 5 метрам if (duration * SOUND_SPEED / 2 <= MAX_DISTANCE) { cm += duration * SOUND_SPEED / 2; // Накопление результата } else { err = 1; // Ошибка, если расстояние превышает максимальное } counter++; } L = cm / k; // Усреднение результатов // Вывод результатов Serial.print("Distance: "); Serial.print(L); Serial.println(" cm"); // Вывод состояния ошибки if (err) { Serial.println("Error: Measurement Timeout or Out of Range"); } // Задержка между измерениями для корректной работы датчика delay(250); }Объяснение изменений:
- Количество измерений: Установлено значение
6для усреднения результатов. - Вывод Trig: Установлен на
PB1, что соответствуетDDB1(пин для TRIG). - Вывод Echo: Установлен на
INT1, что соответствует пинуDDE3(пин для ECHO). - Вывод результатов: Измеренное расстояние будет выводиться в сантиметрах.
Скомпилируйте и загрузите этот код на ваше устройство, чтобы тестировать и убедиться, что всё работает корректно. Убедитесь, что пины действительно подключены к вашему ультразвуковому датчику.
- Количество измерений: Установлено значение
- User
/*
- Лабораторная работа №3
- Ультразвуковой датчик HC-SR04
- Вариант 2:
-
- Количество измерений: 6
-
- Trig: PB1 (цифровой пин 9)
-
- Echo: INT1 (цифровой пин 3)
-
- Формат измерения: см */
#define k 6 // Количество измерений по варианту 2 (изменили с 8 на 6) volatile long duration, cm, L; int counter, err;
///////////////////////////////////////////// // Обработчик прерывания INT1 (x=1 для варианта 2) ISR(INT1_vect) { if (PIND & (1 << PD3)) { // Если высокий уровень на INT1 (PD3) TCNT1 = 0; // Сброс таймера при начале импульса } else { duration = TCNT1; // Фиксация времени при окончании импульса } }
void setup() { Serial.begin(9600); // Инициализация последовательного порта
// Настройка пинов (изменили для варианта 2): DDRB |= (1 << PB1); // PB1 (Trig, пин 9) как выход (было PB3) DDRD &= ~(1 << PD3); // PD3 (Echo, пин 3) как вход (осталось как в варианте 4)
// Настройка таймера T1 (без изменений): TCCR1A = 0; // Режим Normal TCCR1B = (1 << CS10); // Без предделителя (clk/1) TCCR1C = 0;
// Настройка прерывания (без изменений): EICRA |= (1 << ISC10); // Любой фронт (ISC11=0, ISC10=1) EIMSK |= (1 << INT1); // Разрешить прерывание INT1 sei(); // Разрешить глобальные прерывания }
void loop() { counter = 1; cm = 0;
while (counter <= k) { // Теперь 6 измерений (было 8) /* Генерирование импульса 10 мкс на Trig (PB1 вместо PB3) */ PORTB |= (1 << PB1); // Установить PB1 (пин 9) в HIGH delayMicroseconds(10); PORTB &= ~(1 << PB1); // Установить PB1 в LOW
err = 0; TCNT1 = 0; // Ожидание измерения: duration = 0; while(!duration) { if(TCNT1 > 65500) { // Защита от переполнения err = 1; break; } } if (!err) { // Преобразование времени в расстояние (теперь в СМ): // Частота таймера 16 МГц, 1 тик = 1/16 мкс // Формула для см: (duration/16)/58 ≈ duration/928 cm = cm + (duration / 928); // Изменили коэффициент с 93 на 928 } counter++;}
L = cm / k; // Усреднение 6 измерений
// Вывод в сантиметрах (было в мм): Serial.print("Расстояние: "); Serial.print(L); Serial.println(" см"); // Изменили единицы измерения
if (err) { Serial.println("Ошибка измерения!"); }
delay(250); // Пауза между измерениями } Переделай этот код, чтобы работало на расстоянии 5 метров
- Assistant
Чтобы обеспечить стабильное измерение расстояний до 5 метров, необходимо внести изменения в код, касающиеся обработки времени отражения импульса и оптимизацию условий измерения для предотвращения ошибок из-за слишком большого времени.
Вот как может выглядеть исправленный код с учётом ваши требований:
Обновлённый код для работы на расстоянии до 5 метров:
/* * Лабораторная работа №3 * Ультразвуковой датчик HC-SR04 * Вариант 2: * - Количество измерений: 6 * - Trig: PB1 (цифровой пин 9) * - Echo: INT1 (цифровой пин 3) * - Формат измерения: см */ #define k 6 // Количество измерений по варианту 2 #define MAX_DISTANCE 500 // Максимальное расстояние в см (5 метров) #define SOUND_SPEED 0.034 // Скорость звука в см/мкc volatile long duration, cm, L; int counter, err; ///////////////////////////////////////////// // Обработчик прерывания INT1 (x=1 для варианта 2) ISR(INT1_vect) { if (PIND & (1 << PD3)) { // Если высокий уровень на INT1 (PD3) TCNT1 = 0; // Сброс таймера при начале импульса } else { duration = TCNT1; // Фиксация времени при окончании импульса } } void setup() { Serial.begin(9600); // Инициализация последовательного порта // Настройка пинов: DDRB |= (1 << PB1); // PB1 (Trig, пин 9) как выход DDRD &= ~(1 << PD3); // PD3 (Echo, пин 3) как вход // Настройка таймера T1: TCCR1A = 0; // Режим Normal TCCR1B = (1 << CS10); // Без предделителя (clk/1) TCCR1C = 0; // Настройка прерывания: EICRA |= (1 << ISC10); // Любой фронт (ISC11=0, ISC10=1) EIMSK |= (1 << INT1); // Разрешить прерывание INT1 sei(); // Разрешить глобальные прерывания } void loop() { counter = 1; cm = 0; while (counter <= k) { // Теперь 6 измерений // Генерирование импульса 10 мкс на Trig (PB1) PORTB |= (1 << PB1); // Установить PB1 (пин 9) в HIGH delayMicroseconds(10); PORTB &= ~(1 << PB1); // Установить PB1 в LOW err = 0; TCNT1 = 0; // Ожидание измерения: duration = 0; while(!duration) { if(TCNT1 > 65500) { // Защита от переполнения err = 1; break; } } if (!err) { // Проверка, что расстояние не превышает 5 метров long distance = (duration * SOUND_SPEED) / 2; // Дистанция в сантиметрах (вместо LM) if (distance <= MAX_DISTANCE) { cm = cm + distance; // Накопление результата } else { err = 1; // Ошибка, если расстояние превышает 5 метров } } counter++; } L = cm / k; // Усреднение 6 измерений // Вывод в сантиметрах Serial.print("Расстояние: "); Serial.print(L); Serial.println(" см"); if (err) { Serial.println("Ошибка измерения!"); } delay(250); // Пауза между измерениями }Изменения в коде:
- Установлена максимальная дистанция: Добавлена константа
MAX_DISTANCE, равная 500 см (5 метрам). - Обработка
distance: Строкаlong distance = (duration * SOUND_SPEED) / 2;заменяет прямое вычисление в сантиметрах, чтобы легче было обрабатывать расстояние и проверять превышение 5 метров. - Проверка на превышение максимальной дистанции: Измерение
distanceпроверяется, и если оно превышает 5 метров, то устанавливается флаг ошибки.
Эти изменения помогут обеспечить стабильные измерения в диапазоне до 5 метров. Проверьте и протестируйте код с вашим оборудованием, чтобы убедиться, что все работает правильно.
- Установлена максимальная дистанция: Добавлена константа