MAL4Xсамодельные симуляторы: платформы, кокпиты, электроника
Симуляторы

Данные: что передавать и как регулировать

Тема из архива сообщества MAL4X: 102 сообщения, 2012. Обсуждение закрыто, ссылки и цены в сообщениях могли устареть.

admin

-

kuzevan

При создании этого проекта использовалось следующее оборудование:
Arduino Uno,
Двойной драйвер двигателя Pololu http://pololu.com/catalog/product/707
,
Блок питания SP-480-12, который я собираюсь заменить на http://aliexpress.com/item/F...t/597489887.html
.
Двигатель стеклоочистителя от Газели (сима у меня пока нет). Подключены желтый и черный провода.
Платформа Arduino была выбрана по причине криворукости и лени. Симостроители ее избегают по причине нестабильной работы COM на скорости 115200. Действительно, таблица в http://x-sim.de/forum/viewto...ino+250000#p3340
говорит о том, что там 2.1% процента ошибок, но я подумал, что я не космическими аппаратами собираюсь управлять.
Идеальный контроллер должен работать по простой формуле, знакомой с детства:
S=S0+V0*t +A*t*t/2
То есть, контроллер получает из управляющей программы следующую координату S. Допустим, он знает свое положение S0 (прочел потенциометр), и скорость, в которой находится V0. Приняв период времени (33мс) за единицу, получим:
A=2*((S-S0)-V0)
Вот такое ускорение надо придать мотору, чтобы он оказался в нужное время в нужном месте. Скорость в этот момент должна быть V0+A, это будет новым значением V0 для следующего цикла.
Стоит вопрос о том, какой ШИМ надо подать на двигатель, чтобы получить это ускорение. И здесь уже надо гонять конкретный двигатель. Я погонял. Выяснилось, что за свои пол-оборота он никогда не достигает номинальной скорости, а работает в режиме разгон-торможение. Весьма приблизительно данные были аппроксимированы. Получилось следующее:
Есть две фазы. Разгон – это когда направление вращения совпадает с силой и торможение, когда они противоположны. Я принял линейную аппроксимацию зависимости ускорения от ШИМа, хотя это не совсем так. Для моего двигателя (без нагрузки):
Для ускорения: ШИМ=57*A+42 .
Для торможения ШИМ=57*A/2+42.
Но это все теория, на практике из-за несовершенства двигателя и модели, динамической нагрузки это правильно работать не будет.
На сегодня все, в следующие разы программа для Ардуино для измерения параметров двигателя и программа для сима.

Ale

kuzevan писал(а):

Платформа Arduino была выбрана по причине криворукости и лени. Симостроители ее избегают по причине нестабильной работы COM на скорости 115200. Действительно, таблица в http://x-sim.de/forum/viewto...ino+250000#p3340
говорит о том, что там 2.1% процента ошибок, но я подумал, что я не космическими аппаратами собираюсь управлять.

Ага, это я там засветился
Проблема со скоростью 115200 актуальна только для старого софта x-sim2. Буквально пару недель назад SirNoName по моей настоятельной просьбе включил в x-sim3 поддержку нестандартных скоростей, которые совершенно спокойно устанавливаются при использовании FTDI чипов.
Так что arduino теперь тоже рулят, для них можно вполне ставить скорость COM - порта = 250000 бод и работать без всяких ошибок. Кстати, в нашем софте эта фича со скоростями была с самого начала

Ale

kuzevan писал(а):

Конечно, надо бы помощней и порезвей. А что ты предлагаешь?

Я бы себе вот такую штуку прикупил бы
Штука

А вообще тут уже в который раз заводят разговор о шаговиках. Я начинаю смотреть, что это за звери такие

taran_ob

kuzevan писал(а):

Вот такое ускорение надо придать мотору, чтобы он оказался в нужное время в нужном месте.


Это не возможно, потому что новую координату мы получаем уже тогда когда когда должны быть там. То есть всегда есть какое то рассогласование позиции, а от мощности мотора и инерционности зависит величина этого рассогласования. Контроллер должен уметь это рассогласование поддерживать минимальным - выступать в качестве регулятора. Самый простой вариант это пропорциональный регулятор. В единичный момент времени проводится расчет рассогласования (ошибки) положения и умножается на некий коэффициент (Кp) в результате получаем величину воздействия на систему необходимую для достижения минимального рассогласования. Превышение коэффициентом определенного значения приводит к перерегулированию которое может быть полезным в случае движения в одном направлении-уменьшается рассогласование в следующем шаге, а в случае реверса - увеличивается.
К скорости вообще нет смысла привязываться, так как для сима величина бесполезная. Важны положение в пространстве (наклон) - статические ощущения, ускорение - для ощущения динамики и ,я думаю, третья производная координаты, возникающая из-за люфта в шарнирах, неоднозначного момента инерции, вызывающая дискомфорт - тошноту, головокружение.
С положением в пространстве проблем нет - обратная связь по датчикам. С ускорением в принципе тоже, при условии что момент инерции и масса константы. А вот третья производная ни как пока не оценивается.
В идеале регулятор (контроллер) должен на выходе выдавать такое значение воздействия чтобы:
1 рассогласование было минимальным и не зависело от момента инерции
2 третья производная координаты (скорость ускорения, толчек) не превышала определенного значения.

(Добавление)
Рассогласование. В случае кинотеатра - картинку пускаем чуть позже, тем самым уменьшаем рассогласование. А в симе? Думаю к П регулятору нужно добавить интегральную составляющую. ПИ регулятор быстрей чем П. Интегральная составляющая, как бы оценивает тенденцию изменения ошибки, "предугадывает" положение в следующем шаге. Величина этого "предугодания" коэффициент Ki.
Не зависимость от момента инерции. Настраиваем сим на максимальную допустимую нагрузку без перерегулирования. А дальше как то оценивать перерегулирование которое может возникнуть при изменении нагрузки и вносить поправку в Kp(Ki) ???
Третья производная. В каждом шаге рассчитывать и если меньше(больше) заданного значения, то уменьшать (увеличивать) воздействие. Как рассчитать. В памяти держать последние 3 координаты и с учетом заданной (4 координаты) считать изменение ускорения. Но тут лажа со сменой направления. Считать как то по модулю???

Остается еще один важный фактор - это "правильность" передаваемых координат которые скрывают в себе информацию о перегрузках, но туда я еще не лез.

ПС я везде так много говорю - болтун я, вы скажите если что...

kuzevan

Действительно, координату получаем, когда она уже должна быть отработана. Но другой у нас нет. Выходом может быть предсказание будущей координаты по текущей координате и скорости и стремление к ней. Потом попробую.
Пропорциональные и прочие ПИД регуляторы прёдназначены совсем для других целей - достичь нужной позиции и остановиться там. Наша задача совсем другая - достичь цели с нужной скоростью. Для обеспечения непрерывности движения.
Насчет ощущений ты не прав. Мы чувствуем не положение, а силы, то есть ускорения. И для этого управление по законам динамики идеально.

Ale

Хорошо, что вы нашли друг друга.

taran_ob писал(а):

я везде так много говорю - болтун я, вы скажите если что...

В нашем случае - лучше говорить, чем молчать. Я с обоими согласен. В том плане - что меня не устраивает "традиционная" схема регулирования. У меня тоже есть свой взгляд на эту тему, но он еще не сформулировался...

kuzevan

Про болтуна пишет не kuzevan.

taran_ob

kuzevan писал(а):

Выходом может быть предсказание будущей координаты по текущей координате и скорости

Вот для этого и придумали ПИД регуляторы, чтоб предсказать и быстро отреагировать. В пропорциональной составляющей мы определяем мгновенную скорость как разность текущей и полученной координаты (рассогласование) в единицу времени (период расчета ПИД) умноженную на пропорциональный коэффициент. В следующем периоде она уже будет другая, в результате имеем движение с ускорением повторяющее ускорение принятое в виде координат.Начальная скорость для расчета нам не нужна, потому чо в каждом периоде она уже есть физически. Нарисуй график произвольного движения и разбей его на короткие участки времени...

kuzevan писал(а):

Пропорциональные и прочие ПИД регуляторы прёдназначены совсем для других целей - достичь нужной позиции и остановиться там.

Правильно, оставаться на месте если нет другого задания, по этому мы и должны (в идеале) получать новое задание в каждом периоде расчета шим. На практике это подтверждается степ дир ПИД сервоконтроллером. Не смотря на то что управление происходит дискретно, шагами, вал двигателя вращается плавно без рывков и в случае резкой остановки происходит не большой перелет для компенсации которого используют энкодеры с большим разрешением. Если бы твое утверждение было верным ни кто бы не стремился менять шаговики на серво.

kuzevan писал(а):

Наша задача совсем другая - достичь цели с нужной скоростью.

Абсолютно не противоречит сказанному выше, но акцент не нужно делать на скорости. Нам нужно быть там где говорит игра. Я сказал

taran_ob писал(а):

1 рассогласование было минимальным и
, расшифрую - оказаться в заданной точке как можно быстрее. Ведь если мы стремимся к минимальному рассогласованию, скорость стремится к 0. Если мы уже находимся у цели скорость должна быть 0!

kuzevan писал(а):

Насчет ощущений ты не прав. Мы чувствуем не положение, а силы, то есть ускорения. И для этого управление по законам динамики идеально.

Не понял в чем я не прав. Я сказал что важны ускорение для ощущения динамики и положение в пространстве - если мы на вираже сидим под углом это же интересно. По этом в симе нужно двигать жопу, ведь центр масс практически там. А чтоб не насиловать вестибулярный аппарат нужно контролировать третью производную.
А о скорости в симе говорить нет смысла так как величина не ощутимая.

Ale

kuzevan писал(а):

Про болтуна пишет не kuzevan.

Извини, уже поправил

taran_ob писал(а):

Нам нужно быть там где говорит игра. Я сказал

Забыл добавить в начале фразы "Хау" Насколько я помню, настоящие индейцы именно так выражаются

taran_ob писал(а):

оказаться в заданной точке как можно быстрее.

Позволю себе не согласиться. Не надо оказываться в заданной точке как можно быстрее. Нужно в ней оказаться к нужному моменту времени...

kuzevan писал(а):

Наша задача совсем другая - достичь цели с нужной скоростью. Для обеспечения непрерывности движения.

вот-вот-вот. И я того же мнения.

kuzevan писал(а):

Действительно, координату получаем, когда она уже должна быть отработана. Но другой у нас нет. Выходом может быть предсказание будущей координаты по текущей координате и скорости и стремление к ней.

Предлагаю упростить задачу. Давайте к моменту прихода новой координаты достигнем предыдущей. Тогда мы сможем полностью повторить огибающую (профиль дороги!?!) из игры с задержкой всего в ОДИН период передачи данных. При периоде передачи = 10 мс мы будем отрабатывать данные из игры с задержкой 10мс. Что-то не подсказывает, что это совсем несущественная величина.

Я предлагаю следующую схему - при получении новой координаты рассчитывать скорость перемещения = (X(n) - X(n-1)) /T и заставлять двигатель перемещаться к новому заданию с заданной скоростью.

Таким образом нужен регулятор, позволяющий двигать ось с ЗАДАННОЙ скоростью. В не зависимости от НАГРУЗКИ на ось. Что-то мне подсказывает, что идеальным решением для данной задачи как раз будет уже предлагаемый тут драйвер STEP/DIR вместе с шаговым движком.

taran_ob

Ale писал(а):

Позволю себе не согласиться. Не надо оказываться в заданной точке как можно быстрее. Нужно в ней оказаться к нужному моменту времени...

Как это, к какому моменту? Ведь игра не знает наперед о наших действиях! В момент получения координаты мы уже опоздали!

Ale

taran_ob писал(а):

Как это, к какому моменту? Ведь игра не знает наперед о наших действиях! В момент получения координаты мы уже опоздали!

Так я и предлагаю не забегать на перед. А отстать от игры на один период. Т.е. получить позицию, рассчитать скорость (исходя, естественно, из более менне постоянного периода передачи) и ехать к этой точке, что бы к МОМЕНТУ прихода следующей координаты как раз достичь предыдущей

kuzevan

Двигателем не удается управлять по скорости. Мы не умеем ее задавать и измерять.
Шаговик для этого бы подошел, но я не уверен, что он потянет эти частоты. И вообще, мне кажется, шаговый двигатель - тупиковый вариант.

CraCk

Парни привет!!!
Никого цитировать не буду, нет смысла.
Только скажу что все зависит от мощности двигателей. Если двигатель фуфло он и в Африке фуфло. Если движок не может переместить большой вес относительно своей мощности, тогда вы нечего с этим не поделаете. Если решите проблему с настройкой МК тогда вылезут проблемы с реакцией симулятора. Получается замкнутый круг.
Если вам нужно дешевый вариант и качество обработки в первую очередь обратите внимание на крутной момент двигателя и правильное размещение центра равновесия.
Своего сима еще не собрал жду доставки автокресла которое уже везут 3 месяца этим и не могу подтвердить правильность хода мыслей симостроителей но
все таки, всякие ощущении цитирую своими словами (подвесает форум после каждого ответа учасников. потому не могу дословно процитировать) остановка автобуса производит к дизереонтацыи и тому подобные ощущение это наверное скорее всего проблемы с вестибулярным аппаратом. За четыре года поездок в автобусе на работу не замечал такого. А в общем все дополнителные ощущение можно получить при правильной настройке софта который преобразовывает данные от игры в перемещение.

Ale

kuzevan писал(а):

Двигателем не удается управлять по скорости. Мы не умеем ее задавать и измерять.
Шаговик для этого бы подошел, но я не уверен, что он потянет эти частоты. И вообще, мне кажется, шаговый двигатель - тупиковый вариант.

Стоп-стоп-стоп. Что за упадническое настроение? Что значит - не умеем? Задавать - нет вопросов. Измерять - опрашиваем датчик положения и делим разницу позиций на время. Мы зачем вообще тут собрались? Ставить задачи, обсуждать их и решать.

Я прекрасно понимаю, что СТОЯЧИЙ мотор мгновенно не приобретет нужной скорости. И вообще - изменение скорости процесс энергоемкий и не кратковременный. Но если мы ХОТИМ в точности повторять профиль трассы (а мне кажется как раз к этому надо стремиться), мы не должны ставить задачу достичь следующей точки с максимальной скоростью и там остановиться, ожидая очередного задания. Кстати, сейчас вся ситема именно на это и заточена, как впрочем и классический ПИД. В результате на быстые изменения позиции система не может отреагировать в силу инерционности, а на медленные - доезжает и останавливается... Оно нам надо?

Поэтому я не стал бы так пренебрежительно и безосновательно отзываться о шаговиках

kuzevan

О шаговиках я не отзывался пренебрежительно, напротив, я их люблю. Просто сомневаюсь, что они тянут эти скорости.

CraCk

Ale писал(а):

Я бы себе вот такую штуку прикупил быhttp://motiondynamics.com.au...rs/12v-180w.html

Или эти
http://ebay.com/itm/DC-Motor...h=item58913c7a02

http://ebay.com/itm/25-1-MCP...h=item19c9478c8f

С редуктором можно по комбинировать. Уменьшит передаточное число и увеличить крутной момент.

Ale

kuzevan писал(а):

О шаговиках я не отзывался пренебрежительно, напротив, я их люблю. Просто сомневаюсь, что они тянут эти скорости.

Давай прикинем. Из опыта общения на форумах я для себя выяснил, что перемещение от нижней точки оси до верхней должно занимать порядка 1 секнды на максимальной скорости. Пусть я ошибся и мы усложним задачу - 0.5 секунды. Для движителей с "замедляющими" редукторами это перемещение равно половине оборота вала редуктора - 180 градусов. Редукторы применяются обычно с передаточным числом 25. Итого - Один оборот редуктора в секунду = 25 оборотов в секунду для вала шаговика. Ну а дальше надо смотреть - сколько шагов на оборот. Если 200, то максимальная частота следования импульсов на обмотки составляет 5000 Гц (25*200). Цифра не выглядит фантастической. Мы мостом качаем 20 кГц. Насколько я помню, есть шаговики и с меньшим кол-вом шагов на оборот.
Если я ошибаюсь, поправь меня.

CraCk

Ale писал(а):

Я бы себе вот такую штуку прикупил быhttp://motiondynamics.com.au...rs/12v-180w.html

Или эти
http://ebay.com/itm/DC-Motor...h=item58913c7a02

http://ebay.com/itm/25-1-MCP...h=item19c9478c8f

С редуктором можно по комбинировать. Уменьшит передаточное число и увеличить крутной момент.

taran_ob

Ale писал(а):

Я предлагаю следующую схему - при получении новой координаты рассчитывать скорость перемещения = (X(n) - X(n-1)) /T и заставлять двигатель перемещаться к новому заданию с заданной скоростью.

Блин, так мы говорим об одном и том же!!! (X(n) - X(n-1))-это рассогласование (мгновенная скорость). Только на Т делить не надо так как это константа-период интегрирования (или период расчета шим, в идеале должно быть и периодом приема данных, в общем называйте как хотите), входит в коэффициент пропорциональности, который тоже константа при постоянной массе игрока. А это и есть наш Kp, который "обеспечивает" пропорциональность мгновенной скорости и величины ШИМа для обеспечения этой скорости.

(Добавление)

Ale писал(а):

если мы ХОТИМ в точности повторять профиль трассы (а мне кажется как раз к этому надо стремиться)


ну скорей не профиль трассы, а положение авто в пространстве

Ale писал(а):

мы не должны ставить задачу достичь следующей точки с максимальной скоростью и там остановиться, ожидая очередного задания . Кстати, сейчас вся ситема именно на это и заточена


А этого ни кто и не требует, да это и не возможно ввиду инерционности системы и малого периода приема координат. Мы всегда будем опаздывать, если не будет перерегулирования. А вот чтоб не было перерегулирования, при максимальной динамике нужно добавить интегральную составляющую, увеличивать быстродействие всей системы. Ты сам себе противоречишь, говоря, что нужно повторить профиль трассы и при этом не делать этого быстро. Зачем нам профиль потом, когда мы его уже проехали?

Ale писал(а):

В результате на быстые изменения позиции система не может отреагировать в силу инерционности, а на медленные - доезжает и останавливается... Оно нам надо?


Думаю что это сейчас происходит из-за того, что период расчета ШИМ на много меньше приема координат, и медленного регулятора (без интеграла и дифференциала).

Ale писал(а):

Кстати, сейчас вся ситема именно на это и заточена, как впрочем и классический ПИД

ПИД заточен на то чтоб в любой момент времени рассогласование параметра было минимальным. А какой параметр - не важно. В нашем случае это координата. И чем чаще и быстрей мы будем ее получать, тем ближе мы будем к истиной траектории без всяких аппроксимаций и додумываний. Зачем нам двигаться если машина не двигается?

И не нужно упрощать задачу, хуже все равно получится...

(Добавление)

CraCk писал(а):

Только скажу что все зависит от мощности двигателей.

Это не панацея, хороший контроллер все равно нужен.

CraCk писал(а):

Если решите проблему с настройкой МК тогда вылезут проблемы с реакцией симулятора.

Пытаемся доказать обратное.

CraCk писал(а):

За четыре года поездок в автобусе на работу не замечал такого.

А если стоять и не держаться за поручни, кто вас в конце остановки дергает, думаете инерция? Она тоже, но больше вы сами.

taran_ob

Ale писал(а):

Давай прикинем. Из опыта общения на форумах я для себя выяснил, что перемещение от нижней точки оси до верхней должно занимать порядка 1 секнды на максимальной скорости. Пусть я ошибся и мы усложним задачу - 0.5 секунды. Для движителей с "замедляющими" редукторами это перемещение равно половине оборота вала редуктора - 180 градусов. Редукторы применяются обычно с передаточным числом 25. Итого - Один оборот редуктора в секунду = 25 оборотов в секунду для вала шаговика. Ну а дальше надо смотреть - сколько шагов на оборот. Если 200, то максимальная частота следования импульсов на обмотки составляет 5000 Гц (25*200). Цифра не выглядит фантастической. Мы мостом качаем 20 кГц. Насколько я помню, есть шаговики и с меньшим кол-вом шагов на оборот.Если я ошибаюсь, поправь меня.


Если возвращаться к степдиру. Я почему сразу на него подумал, потому что системы очень похожи. В симе координата дискретная - это шаг. В чпу главное повторить заданную траекторию и в симе тоже. И степдир ПИД сервоконтроллер в чпу - яркий пример того, что ПИД регулятор хорошо справляется с задачей позиционирования. Просто для понимания ПИД, рассматривать систему сима и чпу нужно не в глобальном масштабе времени, а за период получения нового задания (расчета ШИМ).
Но вот на шаговик, я бы сильно не рассчитывал. Повторю главные недостатки. Шум. Потеря момента на резонансной скорости. Сложное управление - очень чувствительное к помехам. Два Н моста на движок. Скачкообразное вращение на малых скоростях в полношаговом режиме. Положительная стороны. Есть полно готовых решений драйверов. Можно обойтись без редуктора. Максимальная частота шага с приличным моментом около 800 - 1000Гц в полном шаге. При 200 шагах на оборот - 300об/мин.

taran_ob

Ale писал(а):



Посмотрел твои исходники, таки ты не любитель... Признаюсь, по началу я тебе недооценил, и предложил использовать готовое решение пид сервоконтроллера совместно с простым контроллером сима. Но теперь уверен что ты бы смог реализовать, предложенную ранее несколькими участниками форума, конфигурацию: на каждый двигатель по контроллеру (интеллектуальному) прямо к компу. В качестве интерфейса взять rs485. Протокол - практически у тебя уже есть свой (нужно только дописать адресацию в режиме конфигурирования, а в рабочем режиме- широковещание, каждый контроллер забирает свою координату), судя по названым цифрам - шустрый. Кто не знает, 485 интерфейс - это два провода (витая пара с синфазными сигналами) на котором запараллелины все устройства(слейвы) вместе с компом(мастер), интерфейс промышленный - помехозащищенный. Микросхема преобразователь rs232-rs485 и обратно стоит менее 1$ и имеет 8 ног. Контроллер типа мега8 или 88, ну или какой то с аппаратным декодированием энкодера, так как на обработку сигналов с него уходи довольно много процессорного времени. В таком варианте все аппаратные ресурсы микроконтроллера будут предоставлены одному двигателю, что в свою очередь должно повысить быстродействие и расширить возможности - быть универсальным!

kuzevan

По шаговикам. Они великолепны в ЧПУ, где требуется точное позиционирование, для этого и созданы. Но в динамических задачах, где мы моделируем действительность, мне кажется, обычные двигатели лучше. Лично я в этом направлении копать не намерен. Но я легко изменю свое мнение, если кто-то опишет положительный опыт.
Скорость они, наверное, потянут, тут я погорячился, но, думаю, там есть и другие подводные камни.

taran_ob

Набросал график для понимания П регулятора.
https://skydrive.live.com/redir?resid=B557CEBDD9406F6D!123

(Добавление)

kuzevan писал(а):

По шаговикам. Они великолепны в ЧПУ, где требуется точное позиционирование, для этого и созданы. Но в динамических задачах, где мы моделируем действительность, мне кажется, обычные двигатели лучше.


Полностью поддерживаю.

(Добавление)
Еще мысль по поводу степдир. Самый большой минус у сервоконтроллера для ЧПУ применительно к симу, как я понял - в качестве параметра регулирования в диф составляющей принимается не координата, как в П и И, а скорость. Для ЧПУ это нужно, для сима - нет. Хотя может на практике и не помешает, сложно представить модель в голове.

taran_ob

  Вот код одностороннего воздействия. Проверенный в регуляторе оборотов.  Для сима осталось ввести отрицательное воздействие (реверс) и, думаю, в качестве параметра регулирования в диф составляющей нужно задавать [b]ускорение[/b], чтоб не возникало [b]толчка[/b] (третья производная координаты). Для одностороннего воздействия как то так:  
(квадрат времени константа, по этому учитываем ее в KOEFd2)  POWER=(KOEFp*ERROR)+(KOEFi*ERRORsum)+((ERRORdelta-ERRORdeltatemp)*KOEFd2);  
ERRORdeltatemp=ERRORdelta        #define POWERmax 252              // максимальная мощность  #define POWERmin 0                  // минимальная мощность  #define KOEFp 2            //коэффициент P  
#define KOEFi 0.06        //коэффициент I  
#define KOEFd 0.4         //коэффициент D    //функция возвращает значение необходимого воздействия по ПИД  
unsigned char PID(unsigned int ITEMset, unsigned int ITEMget)  {  static signed int  POWER, ERRORsum, ERRORdelta, ERRORtemp, ERROR;    ERROR=ITEMset-ITEMget;                                                              //ошибка регулирования                      if ((POWER>0)&(POWER<POWERmax)) ERRORsum=ERRORsum+ERROR;                            //если предел регулирования не достигнут, рассчитываем сумму ошибок  
ERRORdelta=ERROR-ERRORtemp;                                                         //изменение ошибки  ERRORtemp=ERROR;                                                                    //текущая ошибка стала прошлой  POWER=(KOEFp*ERROR)+(KOEFi*ERRORsum)+(KOEFd*ERRORdelta);                            //расчет воздействия по ПИД закону  
if ((POWER>POWERmin)&(POWER<POWERmax)) return (char)POWER; else {if (POWER<=POWERmin) return POWERmin; if (POWER>=POWERmax) return POWERmax;}; //проверка предела воздействия  }

kuzevan

Извините, коллеги, в первом посте я ошибся. Последние две формулы и текст должны выглядеть так:
При положительной скорости (движение вверх)
ШИМ=57*А+42,
При отрицательной (движение вниз)
ШИМ=57*A-42.

Ale

kuzevan писал(а):

Извините, коллеги, в первом посте я ошибся. Последние две формулы и текст должны выглядеть так:
При положительной скорости (движение вверх)
ШИМ=57*А+42,
При отрицательной (движение вниз)
ШИМ=57*A-42.

Как бы эту теорию проверить???

taran_ob

Бред, нельзя говорить о прямой зависимости ускорения от ШИМа!!! Потому что получится вечный двигатель: ШИМ=константа -> ускорение=константа -> скорость=стремится к бесконечности... Вот зависимость скорости от ШИМ - это да.
kuzevan, ты просто не хочешь понять принцип пропорционального регулирования. Любое движение с ускорением можно разбить во времени на движение с постоянной, мгновенной скоростью, которая зависит от шима пропорционально (в идеале). ШИМ=K*((Х-Х0)/t), так как t=const, K=const, то Kp=K/t, следовательно ШИМ=Kp*(X-X0), где Кр-коэффициент пропорциональности, X0 - текущая координата сима, Х - будущая координата сима через время t=const - период интегрирования. Следовательно, если все правильно, то через время t - X0=Х, то есть траектории будут одинаковыми, но с разницей во времени t=const, а это означает что и ускорения в любой момент времени будут одинаковыми.

taran_ob

А это наша главная задача!

taran_ob

ПС Все выше сказанное справедливо без вариантов, если управляющая программа передает нам координаты описывающие траекторию движения авто в пространстве и время интегрирования t стремится к 0. Главная задача увеличить быстродействие регулятора, компенсировать всякие нелинейности и внешние воздействия, о способах писал выше.

taran_ob

Очень рекомендую почитать, не поленитесь http://roboforum.ru/wiki/%D0%9F%D0%B5%D1%80%D0%B5%D0%B2%D0%BE%D0%B4_%D1%81%D1%82%D0%B0%D1%82%D1%8C%D0%B8_%22%D0%9F%D1%80%D0%BE%D1%81%D1%82%D0%BE_%D0%BE_%D0%9F%D0%98%D0%94-%D0%B0%D0%BB%D0%B3%D0%BE%D1%80%D0%B8%D1%82%D0%BC%D0%B0%D1%85%22

taran_ob

Ale писал(а):

Как бы эту теорию проверить???


Было бы здорово, чтоб в программе управления была возможность подгрузить семпл - текстовый файл с произвольной траекторией, включающей в с себя максимальные перегрузки. Эту траекторию отображаем на графике одним цветом. Шлем координаты из траектории в контроллер. В ответ на координату, контроллер возвращает текущую координату, по которой программа рисует траекторию другим цветом. Настройка контроллера (всякие коэффициенты) сводится к тому чтоб графики эталонной и реальной траекторий максимально совпадали. При таком подходе, сим сможет настроить и ребенок, не понимающий ни чего в ПИД.

taran_ob

Еще одно практическое пожелание к регулятору. Номинальное напряжение моих движков 48В. Есть трансформаторы с обмоткой 56В, после выпрямителя с конденсатором 56*1.4=78.4В. Хотелось бы иметь возможность задавать максимальное значение ШИМ, тем самым программно ограничивать ток через двигатель, так как аппаратного ограничения тока в мостовом драйвере может и не быть. Но для этого желательно иметь ШИМ с большей разрядностью, хотя бы 512.

Ale

taran_ob писал(а):

желательно иметь ШИМ с большей разрядностью, хотя бы 512.

Сейчас реализован 10-битный шим - 1024 значения. Ограничить - нет проблем

Ale

taran_ob писал(а):

Было бы здорово, чтоб в программе управления была возможность подгрузить семпл - текстовый файл с произвольной траекторией

Уже реализовано в отладочной программе xSimCTRL.exe

taran_ob

Пардон, не доглядел...
А что скажешь по поводу rs485, с раздельными контроллерами?

Ale

taran_ob писал(а):

А что скажешь по поводу rs485, с раздельными контроллерами?

Нет абсолютно никаких проблем. Но я все еще считаю это избыточным. Самый простой AVRmega имеет на борту ДВА канала аппаратных ШИМ. И уж поверь, расчетных мощностей вполне хватит для реализации ДВУХ даже самых навороченных ПИД каналов. Так что я проголосую за один контроллер на два движка.
А про RS485 - вполне здравая идея. НО требующая доп вложений. На компах такого интерфейса нет. Поэтому по любому придется делать переходник USB-RS на FTDI. Есть несколько путей-
1 - покупка (наверняка есть, я не качал)
2- реализация прямо на плате контроллера, как сейчас есть, но пустить канал 485-й дальше на выход, к которому можно цепочкой подключать следующие контроллеры уже без USB преобрезователей,
3 - изготовление своего преобразователя, автономного, тогда на всех контроллерах вместо USB преобразователя набо будет ставить по две микрухи 485 (на вход и выход)

taran_ob

Ale писал(а):

Самый простой AVRmega имеет на борту ДВА канала аппаратных ШИМ. И уж поверь, расчетных мощностей вполне хватит для реализации ДВУХ даже самых навороченных ПИД каналов.


А как быть если движков 4? Хватит ли мощностей для программной реализации 4ШИМ, 4энкодеров ?

Ale

taran_ob писал(а):

А как быть если движков 4? Хватит ли мощностей для программной реализации 4ШИМ, 4энкодеров ?

Стоп. Если 4 движка - ставим 2 контроллера (ты ведь вообще на 4 движка 4 контроллера предлагаешь ). Это во-первых. Во-вторых - контроллер типа mega644 (в дип корпусе) имеет два канала 16-битных ШИМ (мы из них делаем 10-бит) + два канала 8-битных ШИМ. А вот контроллер mega64 в корпусе tqfp-64 - уже 6 каналов аппаратных 16-битных ШИМ. Но плату под его в домашних условиях трудно изготовить. Я себе сделал, но я на заводе заказываю.
Так что на atmega64 ресурсов хватит и на 4 канала.

taran_ob

В принципе согласен, но есть несколько доводов:
1 ЛУТом сделать 4 одинаковые, маленькие платки, скажем с мега8 или вообще с тини2313 если отказаться от аналоговых датчиков, гораздо проще чем одну с монстром с 64 ногами.
2 У меня есть отрицательный опыт в управлении несколькими мощными индуктивными нагрузками от одного МК. Считаю, что гальванически развязывать мосты друг от друга нужно обязательно. Да это и удобно, потому что найти блок питания, скажем, на 800 Вт для 4х движков сложнее чем 4х200 Вт. При реализации управления от одного МК придется ШИМить через оптроны, а это не совсем правильно. А если появится необходимость в обратной связи по току - вообще труба. Проще и правильней развязать rx232.
3 Написать программу МК для управления одним двигателем проще чем для 4х.
4 С разделением - конструкция становится модульной, что тоже +.

taran_ob

Мы наверно не много офтопим?

kuzevan

Выкладываю программку для Ардуино управления двигателем.
/*
Программа управления одним двигателем 
от управляющей программы Ale
c kuzevan
*/
//ноги Ардуино
#define INA 8
#define INB 9
#define _PWM 10
#define AT 0

#define DEG 300.0
#define K1 57.0
#define K2 42.0
#define MAX_TIME 34

String inputString = "";         // a string to hold incoming data
boolean stringComplete = false;  // whether the string is complete

int pmax,pmin;//мин и макс потенциометра
int dest,dest_p,pot,pos,last_pos,dir;
byte speed_pwm;
float acc,v0;
long pwm, pwm_d;
float max_acc;
int timer;
char outputString[]="[000000000000000000000000]";

void setup()
{
  pmin=(unsigned int)(1024.0*((DEG-180.0)/2)/DEG);
  pmax=(unsigned int)(1024.0*((DEG-180.0)/2+180.0)/DEG);
  v0=0.0;
  max_acc=(255.0-K2)/K1;
  last_pos=map(analogRead(AT),pmin,pmax,0,255);
  dir=0;
  speed_pwm=0;
  inputString.reserve(32);
  Serial.begin(115200);
}

void loop()
{
  if(stringComplete){
    dest=(byte)inputString.charAt(3);
    timer=millis();
    dest_p=map(dest,0,255,pmin,pmax);
    pos=map(analogRead(AT),pmin,pmax,0,255);
    acc=2.0*((float)(dest-pos)-v0);
    //вычисление ШИМ
    if(v0>=0)
        pwm=(long)(K1*acc+K2);//вверх
    else
        pwm=(long)(K1*acc-K2);//вниз
    //перезапуск двигателя
    Restart();
    if(pwm==255)
        v0=(float)(pos-last_pos)+max_acc*1.5;
    else if(pwm==-255)
        v0=(float)(pos-last_pos)-max_acc*1.5;
    else
        v0=(float)(dest-pos)+acc/2.0;
    last_pos=pos;
    inputString = "";
    stringComplete = false;
  }
  pot=analogRead(AT);
  if((millis()-timer)>MAX_TIME){
    Go(0,0);
  }
  ToString(2,outputString+1,dest);
  ToString(4,outputString+3,map(pot,pmin,pmax,0,255));
  ToString(4,outputString+7,pwm_d+255);
  Serial.print(outputString);
}

void serialEvent() {
  while (Serial.available()) {
    // get the new byte:
    char inChar = (char)Serial.read();
    // add it to the inputString:
    inputString += inChar;
    delayMicroseconds(100);
  }
  if((byte)inputString.charAt(2)==0xFF){
    stringComplete = true;
  }
  else
    inputString = "";
}

void Restart(void)
{
  int d;
  if(pwm<0) d=-1;
  else d=1;
  if(pwm>255) 
    pwm=255;
  else if(pwm<-255)
    pwm=-255;
  Go(d,(byte)(d*pwm));
}

void ToString(int n,char *buf, int val)
{
  int i,k;
  for(i=n-1;i>=0;i--){
    k=val%16;
    if(k>9) buf[i]=(char)k+'A'-10;
    else buf[i]=(char)k+'0';
    val/=16;
  }
}

void Go(int d,byte s)
{
  if(d!=dir){
    analogWrite(_PWM,0);
    speed_pwm=0;
    digitalWrite(INA, LOW);
    digitalWrite(INB, LOW);
    if(d==1)
      digitalWrite(INA, HIGH);
    else if(d==-1)
      digitalWrite(INB, HIGH);
    dir=d;
  }
  if(s!=speed_pwm){
    analogWrite(_PWM,s);
    speed_pwm=s;
  }
}

Написана без изысков, по теории, изложенной в первом посте.
При использовании надо поправить цифры в #define:
-ноги Ардуино
- рабочий оборот потенциометра DEG
- параметры двигателя К1 и К2, они здесь для газелевского. Программку для их определения выложу позже.
Управлять двигателем можно из программы Ale http://mal4x.ru/viewtopic.php?f=6&t=209, или любой, дающей стандартный выход на контроллер.
Программа Ale дала такую картинку:

Заметно, что значения ШИМ почти всегда занимают крайние положения, запаса по мощности нет, можно, даже, релейное управление применять.
Если кто-нибудь потестит, прошу отписаться.

null

kuzevan писал(а):

Программа Ale дала такую картинку:

Это картинка с реального мотора под нагрузкой?

kuzevan

Без нагрузки. Пока нагрузить нечем, симулятора нет, а городить что-то лень.

null

а что за мотор и что использовано в качестве обратной связи? потенциометр?

kuzevan

Мотор от газелевского стеклоочистителя, потенциометр СП3-400, 10к (дерьмо, шумный очень), закреплен на обратной стороне вала.

AlexVr

kuzevan писал(а):

Выкладываю программку для Ардуино управления двигателем.


Очень-очень интересно. Ардуинка есть, возможность потестить тоже, исходников от Ale нет.
Можно сразу вариант с прошивкой с описанием ног?

Ale

AlexVr писал(а):

исходников от Ale нет.

Пришлю... Скажи куда? (в личку)

AlexVr

Только мне бы вариант готовой прошивки, а то я накозявлю с программой
А ноги Ардуинки я любые подпаяю!
Alex-vr@ya.ru

Ale

AlexVr писал(а):

Только мне бы вариант готовой прошивки, а то я накозявлю с программой
А ноги Ардуинки я любые подпаяю!

Нее. Я тебе пришлю исходники для платы AMC1.5. Других у меня нет. По поводу прошивки для ардуины - это к kuzevan. Но насколько я знаю, ты можешь срисовать с сайта тот код, который он прислал, и вставить его в скетч. Откомпилировать и загрузить в ардуину. Или я не прав?

AlexVr

Если бы я знал

Ale

kuzevan писал(а):

Выкладываю программку для Ардуино управления двигателем.

Хм... Не нашел в тексте где присваивается хоть какое нибудь значение переменной pwm_d.
Тем не менее на вывод ты ее отправляешь

kuzevan писал(а):

ToString(4,outputString+7,pwm_d+255);

И кстати, на могу найти логики в прибавлении 255-и.

kuzevan

Хмм... Описочка вышла, правил перед отсылкой и поспешил. Там просто pwm надо.
ШИМ у меня изменяется от -255 до 255, я не был уверен, что отрицательные значения отображаются корректно и прибавил 255.
Про ноги напишу завтра и завтра, наверное выложу программу измерения параметров двигателя.

Ale

kuzevan писал(а):

Хмм... Описочка вышла, правил перед отсылкой и поспешил. Там просто pwm надо.

Тщательнее надо, товарищ (С)
.

kuzevan писал(а):

ШИМ у меня изменяется от -255 до 255, я не был уверен, что отрицательные значения отображаются корректно

Должно корректно отображаться... Попробуй...

taran_ob

kuzevan писал(а):

Заметно, что значения ШИМ почти всегда занимают крайние положения, запаса по мощности нет, можно, даже, релейное управление применять.


Чтоб улучшить динамические характеристики привода, можно запитать его повышенным напряжением, скажем 24В и при этом ограничить шим до 50%. За счет повышения напряжения ток в обмотках двигателя будет наростать быстрее, а следовательно и момент.

null

taran_ob писал(а):

Чтоб улучшить динамические характеристики привода, можно запитать его повышенным напряжением, скажем 24В и при этом ограничить шим до 50%.

Мысль оригинальная, но не понял как от этого повысится напряжение .... разъясни пожалуйста если не сложно

Ale

taran_ob писал(а):

Чтоб улучшить динамические характеристики привода, можно запитать его повышенным напряжением, скажем 24В и при этом ограничить шим до 50%.

Имхо, динамику разгона можно будет увеличить в таком случае только, если на некоторое время давать ПОЛНЫЙ шим, а только потом свяливастья на безопасные 50%. Иначе никакой разницы не будет. Обмотка ШИМ интегрирует и превращает 50% от 24 В в привычные 12 В.

taran_ob

Момент на валу двигателя зависит от тока! Но так как индуктивность обмоток противодействует нарастанию тока, то максимальный ток в обмотке вызванный приложенным напряжение появится через некоторое время (максимальные обороты на валу появляются не сразу), так вот чтоб это время сократить нужно поднять напряжение так как от него зависит ток. Чтоб не превысить допустимый ток двигателя при этом - ограничиваем шим. Такой режим питания двигателя эффективен только при разгоне и активном (режим когда шим подается на оба плеча в противофазе) торможении.

taran_ob

Пардон, наверно я все таки не прав - ШИМ нужно ограничивать не программно, а аппаратно. Резистивный датчик тока и компаратор запрещающий программный шим.

taran_ob

Получается так, допустим есть большое рассогласование, регулятор рассчитал шим 100%, но реально на выходе все 200% и как только при этих 200% ток станет максимально заданным, компаратор начнет резать программный шим до 50%.

kuzevan

Выкладываю обещанную сервисную программу для теста мотора.
/*
Программа диагностики мотора
Вход:
1 - чтение потенциометра, прекращается вводом любого символа
2 - определение полярности
3 - расчет коэффициентов двигателя
*/
#define INA 8
#define INB 9
#define _PWM 10
#define AT 0
#define CNT 5
#define DEG 300.0

boolean serialIn;
char buf[8];
int pmin,pmax,pot;
int dir;
byte speed_pwm;
long sum;
float a1,a2,k1,k2;
boolean use_pot;

void setup()
{
  pmin=(int)(1024.0*((DEG-180.0)/2)/DEG);
  pmax=(int)(1024.0*((DEG-180.0)/2+180.0)/DEG);
  serialIn=false;
  dir=0;
  speed_pwm=0;
  use_pot=false;
  Serial.begin(9600);
}

void loop()
{
  int i,k;
  if(serialIn){
    serialIn=false;
    use_pot=false;
    switch(buf[0]){
      case '1':
        use_pot=true;
      break;
      case '2':
        pot=analogRead(AT);
        Go(1,255);
        delay(132);
        Go(0,0);
        delay(100);
        i=analogRead(AT);
        if((i-pot)>1)
          Serial.println("OK");
        else if((i-pot)<-1)
          Serial.println("Change pot polarity");
        else
          Serial.println("Error");
        Serial.print("pot=");Serial.println(i);
      break;
      case '3':
        pot=analogRead(AT);
        if(pot>512)
          k=-1;
        else
          k=1;
        sum=0;
        for(i=0;i<10;i++){
          pot=analogRead(AT);
          Go(k,255);
          delay(33*CNT);
          sum+=k*(analogRead(AT)-pot);
          Go(0,0);
          delay(1000);
          k=-k;
        }
        a1=2.0*(float)(map(sum/10,0,pmax-pmin,0,255))/(float)(CNT*CNT);
        pot=analogRead(AT);
       // Serial.println(sum/10);
        //Serial.println(map(sum/10,0,pmax-pmin,0,255));
        if(pot>512)
          k=-1;
        else
          k=1;
        sum=0;
        for(i=0;i<10;i++){
          pot=analogRead(AT);
          Go(k,127);
          delay(33*CNT);
          sum+=k*(analogRead(AT)-pot);
          Go(0,0);
          delay(1000);
          k=-k;
        }
        a2=2.0*(float)(map(sum/10,0,pmax-pmin,0,255))/(float)(CNT*CNT);
        k1=(255.0-127.0)/(a1-a2);
        k2=255.0-k1*a1;
        Serial.print("K1=");Serial.println(k1);
        Serial.print("K2=");Serial.println(k2);
      break;
      default:
      Serial.println("Command error");
    }
  }
  if(use_pot){
    Serial.println(analogRead(AT));
    delay(100);
  }
}

void serialEvent() {
  int i=0;
  while (Serial.available()) {
    // get the new byte:
    buf[i++] = (char)Serial.read();
    delay(2); //для 9600
  }
  serialIn=true;
}

void Go(int d,byte s)
{
  if(d!=dir){
    analogWrite(_PWM,0);
    speed_pwm=0;
    digitalWrite(INA, LOW);
    digitalWrite(INB, LOW);
    if(d==1)
      digitalWrite(INA, HIGH);
    else if(d==-1)
      digitalWrite(INB, HIGH);
    dir=d;
  }
  if(s!=speed_pwm){
    analogWrite(_PWM,s);
    speed_pwm=s;
  }
}

Инструкция для использования:
Программа позволяет провести 3 теста:
1. Проверка потенциометра. Побегут циферки значения потенциометра. Удобно, например, выставить пот на середину. Ввести со встроенной консоли (кнопка "Монитор порта" на окне Ардуино) символ '1'. Останавливает этот режим ввод любого символа.
2. Проверка полярности. Потенциометр должен быть уже связан с двигателем. Немного проворачивает двигатель вверх (в сторону подъема платформы). Если двигатель провернулся в обратном направлении - сменить полярность двигателя и провести тест еще раз. Если консоль отвечает "ОК", значит ОК. Если просит сменить полярность потенциометра, значит сменить. Тест проводится вводом символа '2'.
3. Определение коэффициентов двигателя. После ввода '3' двигатель дергается 20 раз и выдает К1 и К2. Холодный двигатель выдает неверные коэффициенты, поэтому тест надо провести раз 5, пока значения не начнут повторяться.

kuzevan

Выкладываю исправленную и дополненную версию программы для Ардуино управления мотором.
Исправлена ошибка, обнаруженная глазастым Ale. Спасибо ему.
В инициализацию добавлены объявления PinMode(), работает и так, но по мануалу положено.
Введена защита от дергания мотора в состоянии покоя.
/*
V0.2
Программа управления одним двигателем 
от управляющей программы Ale
c kuzevan
*/
//ноги Ардуино
#define INA 8
#define INB 9
#define _PWM 10
#define AT 0

#define DEG 300.0
#define K1 84.21
#define K2 46.16
#define MAX_TIME 34

String inputString = "";         // a string to hold incoming data
boolean stringComplete = false;  // whether the string is complete

int pmax,pmin;//мин и макс потенциометра
int dest,last_dest,dest_p,pot,pos,last_pos,dir;
byte speed_pwm;
float acc,v0;
long pwm;
float max_acc;
int timer;
char outputString[]="[000000000000000000000000]";

void setup()
{
  pinMode(INA,OUTPUT);
  pinMode(INB,OUTPUT);
  pinMode(_PWM,OUTPUT);
  pmin=(unsigned int)(1024.0*((DEG-180.0)/2)/DEG);
  pmax=(unsigned int)(1024.0*((DEG-180.0)/2+180.0)/DEG);
  v0=0.0;
  max_acc=(255.0-K2)/K1;
  last_pos=map(analogRead(AT),pmin,pmax,0,255);
  dir=0;
  speed_pwm=0;
  inputString.reserve(32);
  Serial.begin(115200);
}

void loop()
{
  if(stringComplete){
    dest=(byte)inputString.charAt(3);
    timer=millis();
    if(dest==last_dest)
      Go(0,0);
    else{
      dest_p=map(dest,0,255,pmin,pmax);
      pos=map(analogRead(AT),pmin,pmax,0,255);
      acc=2.0*((float)(dest-pos)-v0);
      //вычисление ШИМ
      if(v0>=0)
        pwm=(long)(K1*acc+K2);//вверх
      else
        pwm=(long)(K1*acc-K2);//вниз
      //перезапуск двигателя
      Restart();//ограничивает pwm
      if(pwm==255)
        v0=(float)(pos-last_pos)+max_acc*1.5;
      else if(pwm==-255)
        v0=(float)(pos-last_pos)-max_acc*1.5;
      else
        v0=(float)(dest-pos)+acc/2.0;
      last_dest=dest;
    }
    last_pos=pos;
    inputString = "";
    stringComplete = false;
  }
  pot=analogRead(AT);
  if((millis()-timer)>MAX_TIME){
    Go(0,0);
  }
  ToString(2,outputString+1,dest);
  ToString(4,outputString+3,map(pot,pmin,pmax,0,255));
  ToString(4,outputString+7,pwm+255);
  Serial.print(outputString);
}

void serialEvent() {
  while (Serial.available()) {
    // get the new byte:
    char inChar = (char)Serial.read();
    // add it to the inputString:
    inputString += inChar;
    delayMicroseconds(100);
  }
  if((byte)inputString.charAt(2)==0xFF){
    stringComplete = true;
  }
  else
    inputString = "";
}

void Restart(void)
{
  int d;
  if(pwm<0) d=-1;
  else d=1;
  if(pwm>255) 
    pwm=255;
  else if(pwm<-255)
    pwm=-255;
  Go(d,(byte)(d*pwm));
}

void ToString(int n,char *buf, int val)
{
  int i,k;
  for(i=n-1;i>=0;i--){
    k=val%16;
    if(k>9) buf[i]=(char)k+'A'-10;
    else buf[i]=(char)k+'0';
    val/=16;
  }
}

void Go(int d,byte s)
{
  if(d!=dir){
    analogWrite(_PWM,0);
    speed_pwm=0;
    digitalWrite(INA, LOW);
    digitalWrite(INB, LOW);
    if(d==1)
      digitalWrite(INA, HIGH);
    else if(d==-1)
      digitalWrite(INB, HIGH);
    dir=d;
  }
  if(s!=speed_pwm){
    analogWrite(_PWM,s);
    speed_pwm=s;
  }
}

Описание применения Ардуино для чайников.
Контроллер Arduino Uno имеет 6 аналоговых входов, 10 бит (0-1023), обозначенных на плате A0 – A5. И 14 цифровых входов/выходов 0-13. Из них аппаратный ШИМ поддерживают 6 (3, 5, 6, 9, 10, 11).
На любой аналоговый вход подключаем движок потенциометра, один конец потенциометра – на +5 Ардуино, другой – на землю. Потенциометр может быть любым однооборотным, линейным, от 1к до 10к. Конечно, лучше использовать прецизионные, они меньше шумят и дольше живут. Для защиты от электрических наводок, Ale рекомендует использовать поты 1к и экранировать провода, причем экран подключить к земле только с одной стороны - на контроллере. Следует выяснить рабочий угол потенциометра в градусах, по даташиту, либо измерить. Например, у меня сейчас СП3-400, угол у него 300 градусов.
Драйвер двигателя (Н-мост) у меня управляется тремя цифровыми выходами Ардуино, INA, INB и _PWM. Если INA==1, INB==0, двигатель крутится в одну сторону с ШИМом _PWM. Если INA=0, INB=1 – в другую. Если оба равны 0 – стоит. Если оба единицы – не пробовал и не хочу.
Драйвер у меня, пока, Pololu. Я им сильно разочаровался, при перегреве срабатывает тепловая защита и он вырубается. Часто. Буду менять на китайский.
Возможно, другие драйверы управляются по-другому, не изучал этот вопрос, напишите, переделаю.
Мои программы рассчитаны на некоторые стандартные параметры. Используемый угол потенциометра – средние 180 градусов. Период прихода входных сигналов – 33 мсек, диапазон – 0-255, формат – 5 байт (AB FF a1 a2), скорость 115200.
Загрузка, правка и написание программ в Ардуино осуществляется с программы, которая скачивается с официального сайта. Предварительно надо установить драйверы и сконфигурировать на имеющуюся версию платы и нужный COM порт.
Программы, которые я выкладываю, копипастятся в окно Ардуино.
Но им требуется некоторая настройка под ваше оборудование, которую сделать легко.
В начале программы стоят определители:
#define INA 8 //нога 8
#define INB 9 //нога 9
#define _PWM 10 // ШИМ, нога 10
#define AT 0 //потенциометр, нога А0
#define DEG 300.0 //рабочий угол потенциометра
#define K1 84.21 //коэффициенты двигателя, получаемые от сервисной программы
#define K2 46.16
Вы должны заменить эти значения на те, которые имеются у вас. Не забывайте ставить десятичную точку, где она есть.
Далее, сохраняем файл и нажимаем кнопочку «Загрузить». Все. Программа работает.

kuzevan

Все молчат. Наверное, побежали покупать Ардуино.

AlexVr

Не знаю как все, но я с работы побегу домой - пробовать

taran_ob

Мне немного сложно разбираться в исходниках, но как я понял, если в расчет PWM подставить все переменные, то выражение включает в себя полученную, текущую и прошлую координаты и становится очень похожим на ПИ закон записанный как то, не в обиду, через попу.

А поддержку энкодера ты не планируешь? И сколько движков хочешь подключить?

kuzevan

Вот. А я все думаю, что это Таран про ПИД не пишет...
Про ПИД я все сказал ранее, добавить нечего.
Энкодер не планирую. Движка будет два, но очень легко добавить еще.

taran_ob

kuzevan писал(а):

Про ПИД я все сказал ранее, добавить нечего.

не смотря на то что ты не поддерживаешь ПИД, в своем алгоритме подобие ПИ сам реализовываешь не осознано...

kuzevan

Объясняю в последний раз. Все пропорциональные системы управления так и называются, потому, что управляющий сигнал (ШИМ) внутри цикла пропорционально зависит от расстояния до цели. Чем это расстояние меньше, тем меньше сигнал. Для того, чтобы подойти к цели и остановиться. Я останавливаться не собираюсь, поэтому мой сигнал внутри одного цикла 33 мсек не изменяется от расстояния до цели, следовательно моя система не пропорциональная. Точка.

taran_ob

kuzevan писал(а):

Объясняю в последний раз.

Подожди, не нервничай. Что же, ты хочешь, чтоб все сразу восприняли твой подход? Или код ты выложил для принятия к сведению?
У меня какое то полное недопонимание...

kuzevan писал(а):

Все пропорциональные системы управления так и называются, потому, что управляющий сигнал (ШИМ) пропорционально зависит от расстояния до цели. Чем это расстояние меньше, тем меньше сигнал. Для того, чтобы подойти к цели и остановиться.


100% верно. Все это справедливо в случае если период получения координат намного больше периода расчета шим. На столько больше, что ко времени получения следующего задания, шим проинтегрируется до 0. А речь идет о том, чтоб от задания до задания двигаться с постоянным ШИМ(пропорциональным), и как следствие с постоянной скорость(мгновенной). А так как время между заданиями ооочень маленькое, то ускоренное передвижение сима за какое то время будет состоять из маааленьких передвижений с постоянной скоростью.
И где же здесь остановка???

Мало того, повторюсь, я записал на листике твое выражение для PWM, подставив в него V0 и ACC и в результате получил выражение ооочень похожее на ПИ закон только со своими, пока не понятными мне, коэффициентами k1 k2 1,5 2.

kuzevan писал(а):

Я останавливаться не собираюсь, поэтому мой сигнал не зависит от расстояния до цели, следовательно моя система не пропорциональная.


Как это не зависит от расстояния до цели, если в твое выражение PWM ни чего не входит кроме координат. То что ты их разности обозвал V0 и ACC это ни о чем не говорит. И по графику видно как ты в траекторию попал замечательно. Так что очень даже пропорциональная...

taran_ob

Ты не думай, что мне заняться больше нечем кроме как критиковать и умничать, просто у меня жаба, что твой потенциал программиста, коим я не обладаю, направлен не в то русло, имхо.

kuzevan

Хорошо. Зайду с другой стороны.
Есть у нас задание. Любое. Нагреть воду в котле до 99 градусов за 2 часа, но не до 100, чтобы не закипела. Включаем нагреватель и периодически сравниваем температуру воды с заданной. Чем ближе к 99 градусам, тем ниже подаем мощность на нагреватель. За час нагрели и держим. Подостыла - чуть-чуть греем, нагрели - выключаем. Это пропорциональный регулятор, его цель - 99 градусов, период - 2 часа.
Теперь о нас. Пришел сигнал с новой целью, следующий поступит через 33 мсек. Включаем мотор. Внутри этих 33 мсек мы имеем несколько внутренних циклов, в которых измеряем расстояние до цели, если оно близко, уменьшаем ШИМ. Допустим, достигли цели за 20 мсек. Выключаем мотор. Стоим, ждем новой цели. Это тоже пропорциональный регулятор, точно такой же, как для воды.
Я поступаю совершенно иначе. При поступлении новой цели я вычисляю по простым формулам механики ускорение (и ШИМ), которые должны обеспечить прибытие в заданную цель через заданное время 33 мсек. И подаю этот ШИМ на двигатель. Внутри этого цикла я ничего не измеряю и не корректирую, просто жду новой цели. Зависит ли этот ШИМ от расстояния до цели? Конечно. Зависит ли от начальной скорости? Конечно. Но это совсем не означает, что это пропорциональный регулятор, не надо путать термины.
Еще раз. Внутри цикла у меня никаких коррекций нет, а это краеугольный камень пропорционального регулирования. А приходит новая цель - это новая работа.
А тебе, для домашнего задания, предлагаю написать программку управления через ПИД и потестить ее, это лучше, чем флудить своим ПИДом.
Мою-то можно потестить, а как известно - практика - критерий истины.

taran_ob

kuzevan писал(а):

Теперь о нас. Пришел сигнал с новой целью, следующий поступит через 33 мсек. Включаем мотор. Внутри этих 33 мсек мы имеем несколько внутренних циклов, в которых измеряем расстояние до цели, если оно близко, уменьшаем ШИМ.


Ну, так я же предлагаю не иметь!!!! внутри этих 33мсек никаких внутренних циклов. Соответственно ШИМ уменьшаться не будет! Но лучше, чтоб это были не 33мс, а по меньше.

kuzevan писал(а):

А тебе, для домашнего задания, предлагаю написать программку управления через ПИД и потестить ее, это лучше, чем флудить своим ПИДом.


всему свое время...

kuzevan

Обхохочешься...

taran_ob

kuzevan писал(а):

При поступлении новой цели я вычисляю по простым формулам механики ускорение (и ШИМ), которые должны обеспечить прибытие в заданную цель через заданное время 33 мсек.


Если ты в эту формулу учтешь внешнее воздействие, то в результате самостоятельно выведешь закон ПИД регулирования

AlexVr

kuzevan писал(а):

Выкладываю исправленную и дополненную версию программы для Ардуино управления мотором.


Загрузил, подцепил резистор, запустил прогу от Ale - РАБОТАЕТ!kuzevan, мои поздравления!

kuzevan

То, что работает, меня совсем не удивило. Ты, лучше, напиши, что за двигатель и какие коэффициенты ты получил.

AlexVr

Движки пока не подключал.

kuzevan

Так что же у тебя работает?

AlexVr

Ардуинка с прогой Ale и с резистором.

AlexVr

Полностью все подключил - резистор, мост, частотник, двигатель.
Программа Ale, после выставления компорта 3 на галочках прием, передача зависает и не отвечает.
При повторном запуске все хорошо, график от датчика рисует.
Диод только 1 из 2 на мосту при перемещении ползунка в программе помигивает, на индикаторе частотника направление только в одну сторону и не меняется, хотя задание в обе стороны рисуется на графике.
При нажатии "Пуск" на частотнике программа повисает. При дальнейшем перезапуске пишет, что порт не отвечает.
Резет на Ардуинке не помогает, лечится только переподключением по USB.

taran_ob

kuzevan

Появилось минутка на домашнее задание . Но проверить пока не на чем, Ардуино у меня нет, а над макетом я работаю. Просьба. Не мог бы ты потестить, если время будет? Нужно в твой код вставить одну функцию и по ней вычислять pwm по флагу приема новой координаты. Модуль функции - значение шима, знак - направление. От задания до задания - движение с постоянной скоростью, с компенсацией (медленной) внешнего воздействия. Для настройки, нужно подобрать Kp (начать можно с 0.1) при Ki=0, затем Kp откатить на пару шагов назад, и постепенно увеличивать Ki (начать от Ki=0.0001), процесс не много творческий .

Как то так pwm = модуль PI(dest, pos, 0.1, 0.001)

#define MINACTION -1023
#define MAXACTION 1023
//функция возвращает значение, от MINACTION до MAXACTION, необходимого воздействия по ПИ закону,
//где setItem-заданное значение, getItem-текущее значение, Kp-пропорциональный коэффициент, Ki-интегральный коэффициент 
signed int PI(signed char setItem, signed char getItem, float Kp, float Ki)
{
static float Action;
static signed int deltaItem, tempsetItem, Error, sumError, tempError;
deltaItem=setItem-getItem;                                                              //необходимое изменение 
Error=tempsetItem-getItem;                                                              //ошибка воздействия
tempsetItem=setItem;                                                                    //новое задание стало прошлым
if ((Action>MINACTION)&(Action<MAXACTION)) sumError=sumError+Error;                     //сумма ошибок, если придел регулирования не достигнут 
tempError=Error;                                                                        //текущая ошибка воздействия стала прошлой
Action=(Kp*deltaItem)+(Ki*sumError);                                                    //расчет воздействия 
if ((Action>MINACTION)&(Action<MAXACTION)) return (signed int)Action;                   //возвращает воздействие, если придел регулирования не достигнут
else {if (Action<MINACTION) return MINACTION; if (Action>MAXACTION) return MAXACTION;}; //если воздействие за приделами, возвращает придельные значения
}

taran_ob

kuzevan писал(а):

Введена защита от дергания мотора в состоянии покоя.


Побороть дергание можно, подавая на каждое плече моста одинаковый шим но с инверсией. Это немного уменьшит максимальную скорость, но привод будет, как бы, будет поджат с двух сторон - уменьшается инерционность.

Ale

taran_ob писал(а):

Побороть дергание можно, подавая на каждое плече моста одинаковый шим но с инверсией. Это немного уменьшит максимальную скорость, но привод будет, как бы, будет поджат с двух сторон - уменьшается инерционность.

Не понял ? Пожалуйста подробней. Я использую полумост (как и большинство) - т.е пока первое плечо активно (ШИМ), второе в нуле. Смена полярности - первое плечо в нуль, на второе - ШИМ. Схемотехнический на каждое плечо моего полумоста ШИМ подать нельзя.

А дерганье в состоянии покоя рождается из шумов, выводящих схему из состояния покоя, ИМХО

taran_ob

В таком режиме, при 50% шим - двигатель не вращается, так как 50 на плече А и 50 на плече Б в противофазе, при 95% - 95 на плече А , 5 на Б - вращение вправо, при 5% - 5 на А, 95 на Б - вращение влево. Я такой режим еще не пользовал, но так работает новый сервоконтроллер чена.

В твоем мостике можно это реализовать изменив логику микрухи и-не.

Ale писал(а):

А дерганье в состоянии покоя рождается из шумов, выводящих схему из состояния покоя, ИМХО

и из-за инерционности и медленного регулятора, имхо

Ale

taran_ob писал(а):

В твоем мостике можно это реализовать изменив логику микрухи и-не.


Это уже будет ПОЛНЫЙ мост. Далеко не все могут изменить логику работы на готовых изделиях (на том же Pololu)... Заметь, я не говорю, что полный мост - это плохо

kuzevan

Про дергание в состоянии покоя. Любая система управления дергается в состоянии покоя. Это связано с инерцией системы, которая перескакивает через цель, и ее приходится возвращать обратно. система входит в колебательный режим. Амплитуда этих дерганий зависит от инерционности системы.
Но иногда, а именно в нашем случае, по причине очень слабого мотора дергания могут быть значительны. объясню смысл коэффициентов К1 и К2, которые вычислются моей сервисной програмой. К2 - минимальный ШИМ (из 255 максимум), на который реагирует двигатель. К1 - это тот прирост ШИМа, который дает двигателю ускорение на 1 единицу (из 255) за период 33 мсек. Поясню это на примере. Допустим, двигатель стоит (а не движется) на позиции 127. Новая цель - 128, сдвинуться ему надо всего на 1 ед. Какой шим подать? S=S0+V0*t+A*t*t/2. В этих условиях A=2. Далее, ШИМ=K1*A+K2. При моих К1=84 и К2=46, ШИМ=214. То есть, чтобы сдвинуть мотор всего на 1 позицию нужен почти полный ШИМ. Да и мотор останавливаться там не собирается, эту позицию он проскочит. Вот он и дергается. Поэтому я поступил просто. если пришедшая новая позиция равна предыдущей - мотор выключаю.
Поэтому я и сильно интересуюсь коэффициентами двигателей и прошу потестивших реальные моторы отписаться, что за мотор, какой вольтаж, мощность и полученные коэффициенты.
AlexVR, ты мотор тестил?
А Тарану отвечу, только после вас. Сначала сам свою программу потесть, потом мне присылай, готовую.

kuzevan

Мой алгоритм не позволяет точно позиционироваться, но появилась одна идея.
Если бы на контроллер поступала бы не только следующая координата, но и скорость в ней, то его работу можно было бы значительно улучшить.
Цикл 33 мсек надо разделить пополам. В первую половину - разгоняемся, во вторую тормозим, так, чтобы достигнуть нужной координаты с нужной скоростью. Параметры разгона и торможения рассчитать легко, но нужно знать скорость. Раз уж Ale строит свою программу, попросим его ввести такую опцию?
Например, вместо AB FF s1 s2 передавать FF s1 s2 v1 v2.

taran_ob

Ну и упрямый же ты...
S=S0+V0*t+a*t*t/2, но так как t у нас условно =1, перепишем:
S-S0=V0+a/2 или dS=V0+a/2
Зная, что скорость двигателя, а следовательно и платформы, пропорциональна действующему напряжению на обмотках, и допуская замкнутость системы, можно утверждать, что ШИМ (далее Р) пропорционален скорости V, P~V, следовательно справедливо равенство P=k*V
Изменение шима во времени dP/dt=k*dV/dt, а так как dV/dt=a , то dP/dt=k*a Умножаем обе части равенства на dt: dP=dt*k*a
Так как dt=const, kx=dt*k. Перепишем изменение момента: dP=kx*a (у тебя там от куда то K2 появилось), или a=dP/kx
Подставим a=dP/kx в уравнение равноускоренного движения dS=V0+a/2:
dS=V0+dP/2*kx, или dP=2*kx*dS-V0
Пусть 2*kx=K1, тогда dP=K1*dS-V0 - ни чего не напоминает?
Или P-P0=K1*(S-S0)-V0
Если отбросить P0 и V0 в граничных условиях, то выражение принимает вид пропорциональной составляющей ПИД закона:
P=K1*(S-S0)!!!

taran_ob

kuzevan писал(а):

Если бы на контроллер поступала бы не только следующая координата, но и скорость в ней, то его работу можно было бы значительно улучшить.

Конечно, ты же пытаешься строить параболу , а так в системе координат скорости от времени парабола станет прямой, от этого и тебе и легче...
Это на много все усложняет, координаты достаточно, но передвигаться нужно маааленькими шажочками по отрезкам вдоль параболы, никто этого не заметит, чеснослово...

taran_ob

ОФТОП Предлагаю не ссориться, а совместно сосредоточиться на решении задачи. И не воспринимать критику как личную обиду.

AlexVr

kuzevan писал(а):

AlexVR, ты мотор тестил?


не могу. выше написал почему.

kuzevan

Мотор тестится не той программой, которая подключается к Ale, а другой, сервисной, расположенной в начале третьей страницы. Она начинается со слов "Программа диагностики мотора". Программа Ale к ней не нужна. Сначала проведи тест 2, убедись что пот подсоединен правильно и мотор крутится, потом тест 3. Двигатель должен дергаться туда-обратно. Если только в одну сторону, значит что-то с мостом.

Ale

AlexVr писал(а):

При нажатии "Пуск" на частотнике программа повисает. При дальнейшем перезапуске пишет, что порт не отвечает.
Резет на Ардуинке не помогает, лечится только переподключением по USB.

Признаки "искрения" по земле. Бывает включение люминесцентной лампы вышибает USB с FTDI. На корпусе большого компа как правило 110 Вольт (такой у них фильтр по питанию, на емкостях делится переменное сетевое напряжение). Именно поэтому я свои девайсы стараюсь "опто-развязать".

kuzevan

У меня тоже иногда зависает. Лечу закрытием программ и отключением Ардуино от USB.
Включать программу Ale лучше осторожно, сначала включение приема, потом включение передачи, потом двигаю позицию вручную, убеждаюсь что мотор отслеживает вход, потом включаю генератор. Выключаю в обратной последовательности.

AlexVr

Перепробовал все последовательности включений по 2 раза.
Программы что Ale, что Ардуино виснут на глушняк, с последующей ошибкой порта.
Ардуино получается закрыть только через контрл-альт-дел. А порт восстанавливается только через пару минут методом вкл/выкл через USB.
Все это при включении "Пуска" на частотнике в любой последовательности.
Вывод: Ардуинка и мой частотник по нынешней схеме - несовместимы
Эхх..., а у меня на Ардуинку столько надежд было...

Ale

AlexVr писал(а):

Перепробовал все последовательности включений по 2 раза.

Вывод: Ардуинка и мой частотник по нынешней схеме - несовместимы
Эхх..., а у меня на Ардуинку столько надежд было...

В принципе не все так плохо. Я рекомендую просто провести доработку - отвязать контроллер от силовой части. Цена вопроса - 4 микросхемы 6n135.

kuzevan

Как я понимаю, все претензии, как к автору программ должны быть ко мне.
Во-первых, я не понял, что такое частотник.
Во-вторых, AlexVr, включал ли ты сервисную программу?

null

Судя по всему проблема здесь не в программе. Ale как я понял предлагает поставить оптроны между контроллером и мостом.

Ale

kuzevan писал(а):

Как я понимаю, все претензии, как к автору программ должны быть ко мне.

Не думаю. Скорее проблема не в программе, а в гальванической связи силовой части с контроллером и компьютером. Так что к тебе никаких (пока ) претензий...

kuzevan писал(а):

Во-первых, я не понял, что такое частотник.

Блок частотного преобразователя для регулирования частоты вращения асинхронного движка.
http://ru.wikipedia.org/wiki/%D7%E0%F1%F2%EE%F2%ED%FB%E9_%EF%F0%E5%EE%E1%F0%E0%E7%EE%E2%E0%F2%E5%EB%FC_%28%FD%EB%E5%EA%F2%F0%EE%EF%F0%E8%E2%EE%E4%29
Связка "частотник+асинхронный двигатель" используется вместо связки "мост+двигатель постоянного тока"

AlexVr

kuzevan писал(а):

Как я понимаю, все претензии, как к автору программ должны быть ко мне.


Претензий на этом сайте быть не может. Принципы социалистические, финансовых выгод не предусматривающие

kuzevan писал(а):

Во-первых, я не понял, что такое частотник.

вот моя платформа

Видео: youtube.com


сейчас использую вот такой мост:

http://fotki.yandex.ru/users/alex-vr/view/583421/

kuzevan писал(а):

Во-вторых, AlexVr, включал ли ты сервисную программу?


Я описал попытки выше. Под "Ардуино" я имел в виду софт.
Ведь сервисная программа работает на его базе.

kuzevan

Выкладываю программу для контроллера на Ардуино для двух двигателей.
http://yadi.sk/d/GAZQ95yo1AP4m
Перед использованием, прочтите приложенный ReadMe файл.
Принципиально мало чем отличается от того, что было раньше, просто управление мотором упаковано в класс CMotor.
Но есть одно, маленькое отличие. Дело в том, что в контроллере есть две системы единиц положения, входная (0-255) и внутренняя, потенциометра. В старой программе для одного двигателя я использовал входную, пересчитывая значения потенциометра.
В новой программе я взял за основу единицы положения потенциометра, во-первых пересчитывать не надо, во-вторых точность возрастает в два с лишним раза.
В связи с этим, возникли и новые коэффициенты, вместо K1 и K2 - KP1 и KP2. Пришлось переделать и сервисную программу, теперь она измеряет те и другие коэффициенты.

kuzevan

Немного изменил программу. Находится по тому же адресу,
http://yadi.sk/d/GAZQ95yo1AP4m,
была скачана 5 раз.

Гайды по теме

Ещё в разделе «X-Simulator и SimTools»

Все темы раздела →

Вопросы и ответы

О чём тема «Данные: что передавать и как регулировать»?

- При создании этого проекта использовалось следующее оборудование: Arduino Uno, Двойной драйвер двигателя Pololu http://pololu.com/catalog/product/707 , Блок питания SP-480-12, который я собираюсь заменить на http://aliexpress.com/item/F...t/597489887.html . Двигатель стеклоочистителя от Газели (сима у меня пока…

Кто участвовал в обсуждении?

В архиве сохранилось 102 сообщения (с 17 ноября 2012 по 14 декабря 2012). Больше всего писали: taran_ob, kuzevan, Ale. Тема закрыта, новые ответы не принимаются.

Что такое X-Sim и SimTools?

Программы, которые берут телеметрию из игры (ускорения, крен, тангаж, рысканье) и превращают её в команды для приводов платформы движения. X-Sim — более старый и гибкий конструктор, SimTools проще в настройке и поддерживает много игр через плагины.

Сколько степеней свободы нужно для домашнего симулятора?

Для авто- и авиасимов чаще всего хватает 2DOF (крен и тангаж): это два мотора и простая механика. 3DOF добавляет рысканье или вертикаль, 6DOF (платформа Стюарта) даёт полную свободу, но требует шести приводов, жёсткой рамы и точной настройки.