Дополнительная информация о сенсорах
В главе 5 мы обсудили простейшие приёмы использования сенсоров, но на самом деле с ними можно делать намного больше. В этой главе мы обсудим отличие между режимом и типом сенсора, увидим как использовать старые RCX-совместимые сенсоры и подключать их к блоку NXT используя кабели "Lego converter cable".
Режимы и типы сенсоров
Команда SetSensor(), которую мы видели ранее, реально делает две вещи: она устанавливает тип сенсора и режим, в котором этот сенсор будет работать. Путём установки режима и типа сенсора отдельными полями вы можете более точно контролировать поведение сенсора, что полезно в различных задачах.
Тип сенсора устанавливается командой SetSensorType(). Существует множество различных типов, но я опишу только основные:
- SENSOR_TYPE_TOUCH, сенсор касания,
- SENSOR_TYPE_LIGHT_ACTIVE, датчик освещенности (с включенным светодиодом, т.е. работающий по отраженному свету),
- SENSOR_TYPE_SOUND_DB, датчик звука и
- SENSOR_TYPE_LOWSPEED_9V - ультразвуковой дальномер.
Установка типа сенсора важна для определения нужно ли подавать питание (включает светодиод в датчике освещенности), или для указания модулю NXT, что сенсор цифровой и надо работать с ним по протоколу I2C. Кроме всего прочего допускается использование с NXT сенсоров из старого набора, поставляемого с модулем RCX:
- SENSOR_TYPE_TEMPERATURE, датчик температуры,
- SENSOR_TYPE_LIGHT - старый датчик освещенности,
- SENSOR_TYPE_ROTATION - датчик положения вала (датчик вращения) - этот тип мы обсудим позже.
Режим датчика задаётся командой SetSensorMode(). Существует 8 различных режимов. Наиболее важный - это SENSOR_MODE_RAW. В этом режиме, значение, которое вы получаете от сенсора является числом и лежит в диапазоне 0..1023. Это исходное значение, которое выдаёт датчик. Что оно означает - зависит от того, какой датчик подключен. Например, для датчика касания, когда он не нажат, значение близко к 1023, а когда полностью нажат - близко к 50. При частичном нажатии значение варьируется между 50 и 1000. Так что если вы установите датчик касания в этот режим, вы сможете определять, когда датчик нажат частично. С датчиком освещенности значение варьируется между 300 (очень светло) и 800 (очень темно). Это даёт гораздо значение большей точности, чем при использовании команды SetSensor(). Для более подробной информации смотрите инструкцию по программированию к языку NXC.
|
|
|
Второй режим работы сенсоров - SENSOR_MODE_BOOL. В этом режиме возвращаемое значение 0 или 1. Оно получается из исходного значения 0..1023 сравнением, если меньше 565, возвращается 0, иначе 1. SENSOR_MODE_BOOL является режимом по умолчанию для датчика касания, но может быть быть применен к любому другому сенсору, чтобы убрать аналоговую информацию и оставить двоичный ответ. Режимы SENSOR_MODE_CELSIUS и SENSOR_MODE_FAHRENHEIT полезны только для датчиков температуры и дают ответ в соответствующих единицах измерения. SENSOR_MODE_PERCENT превращает исходное значение 0..1023 в значение между 0 и 100, просто деля его на 1023. SENSOR_MODE_PERCENT является режимом по умолчанию для датчика освещенности. SENSOR_MODE_ROTATION используется только для сенсора вращения (см. ниже).
|
|
|
Есть еще два интересных режима: SENSOR_MODE_EDGE и SENSOR_MODE_PULSE. Они считают переходы между высоким и низким уровнем сигнала с датчика или наоборот. Например, когда мы нажимаете на датчик касания это вызывает переход с высокого к низкому уровню сигнала. Когда вы отпускаете его это вызывает обратный переход. Когда вы устанавливаете сенсор в режим SENSOR_MODE_PULSE, только переходы с низкого на высокий уровень считаются. Так что каждое нажатие и отпускание сенсора касания считается за 1. А когда вы устанавливаете режим датчика в SENSOR_MODE_EDGE, оба перехода засчитываются, т.е. когда вы нажимаете и отпускаете датчик - счетчик увеличивается на 2. Вы можете использовать этот режим для подсчета того, сколько раз нажимали на датчик касания. Или с датчиком освещенности вы можете посчитать как часто включали/выключали освещение. Разумеется, когда вы считаете количество срабатываний или переходов, у вас должна быть возможность сбросить счетчик в ноль. Для этого используйте команду ClearSensor(), которая сбрасывает счетчик для указанного датчика.
|
|
|
Давайте разберем пример. Следующая программа использует датчик касания для управления роботом. Соедините датчик касания длинным проводом со входом 1. Если быстро нажать датчик касания 2 раза - робот поедет вперед, если нажать 1 раз - остановится.
task main()
{
SetSensorType(IN_1, SENSOR_TYPE_TOUCH);
SetSensorMode(IN_1, SENSOR_MODE_PULSE);
while(true)
{
ClearSensor(IN_1);
until (SENSOR_1 > 0);
Wait(500);
if (SENSOR_1 == 1) {Off(OUT_AC);}
if (SENSOR_1 == 2) {OnFwd(OUT_AC, 75);}
}
}
Обратите внимание, что мы сначала установили тип, а только потом - режим работы датчика. Это важно, так как установка типа датчика автоматически сбрасывает режим в значение по умолчанию для этого типа датчика.
Сенсор вращения
Сенсор вращения это очень полезный вид датчика, представляющий из себя оптический энкодер, практический такой же, как встроенный в сервомоторы набора NXT. Датчик вращения имеет отверстие, в которое вы можете вставить вал, относительное угловое положение которого он может измеряет. Один полный оборот вала соответствует 16 шагам (или -16, если вращать в другую сторону), т.е. угловое разрешение датчика - 22.5 градуса, достаточно грубо, если сравнивать с разрешением энкодеров сервомоторов в 1 градус. Этот старый датчик вращения можно использовать для отслеживания положения вала без необходимости задействовать для этого сервомотор; кроме того не забывайте, что старый датчик ввиду отсутствия двигателя внутри гораздо легче вращается.
|
|
|
Если вам нужно большее разрешение, чем 16 шагов на оборот - вы всегда можете использовать шестерни, чтобы механически увеличить его.
Следующий пример унаследован из старого курса для RCX.
Одной из типичных ситуаций является размещение двух датчиков вращения на двух колёсах, которыми вы вращаете с помощью установленных на них же двигателей. Для прямолинейного движения вам нужно, чтобы колёса вращались с одинаково быстро. К сожалению, обычно моторы не вращаются одинаково. Используя датчики вращения вы можете отследить ситуацию, когда один мотор обгоняет другой. Вы можете временно приостановить этот мотор (лучше всего - используя команду Float()), пока оба датчика вращения не выдадут одинаковое значение. Следующая программа реализует этот подход к управлению двигателями. Она просто позволяет роботу ехать строго по прямой. Чтобы проверить её на роботе - подключите датчики вращения к моторам. Подцепите сенсоры на входы 1 и 3.
task main()
{
SetSensor(IN_1, SENSOR_ROTATION); ClearSensor(IN_1);
SetSensor(IN_3, SENSOR_ROTATION); ClearSensor(IN_3);
while (true)
{
if (SENSOR_1 < SENSOR_3)
{OnFwd(OUT_A, 75); Float(OUT_C);}
else if (SENSOR_1 > SENSOR_3)
{OnFwd(OUT_C, 75); Float(OUT_A);}
else
{OnFwd(OUT_AC, 75);}
}
}
Программа сначала определяет, что оба датчика являются датчиками вращения, после чего сбрасывает их значения в 0. Потом запускается бесконечный цикл. В цикле мы проверяем, если значения датчиков совпадают - просто едем вперед. Если же один больше, чем другой - мы приостанавливаем соответствующий двигатель, пока другой не догонит его и датчики снова не покажут равные значения.
На самом деле это очень простая программа. Вы можете расширить её, чтобы робот перемещался на четко заданное расстояние или точно выполнял указанные повороты.
Дата добавления: 2018-05-12; просмотров: 262; Мы поможем в написании вашей работы! |
Мы поможем в написании ваших работ!