Данные: что передавать и как регулировать
Тема из архива сообщества MAL4X: 102 сообщения, 2012. Обсуждение закрыто, ссылки и цены в сообщениях могли устареть.
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.
Но это все теория, на практике из-за несовершенства двигателя и модели, динамической нагрузки это правильно работать не будет.
На сегодня все, в следующие разы программа для Ардуино для измерения параметров двигателя и программа для сима.
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 бод и работать без всяких ошибок. Кстати, в нашем софте эта фича со скоростями была с самого начала
kuzevan писал(а):
Конечно, надо бы помощней и порезвей. А что ты предлагаешь?
Я бы себе вот такую штуку прикупил бы
Штука
А вообще тут уже в который раз заводят разговор о шаговиках. Я начинаю смотреть, что это за звери такие
kuzevan писал(а):
Вот такое ускорение надо придать мотору, чтобы он оказался в нужное время в нужном месте.
Это не возможно, потому что новую координату мы получаем уже тогда когда когда должны быть там. То есть всегда есть какое то рассогласование позиции, а от мощности мотора и инерционности зависит величина этого рассогласования. Контроллер должен уметь это рассогласование поддерживать минимальным - выступать в качестве регулятора. Самый простой вариант это пропорциональный регулятор. В единичный момент времени проводится расчет рассогласования (ошибки) положения и умножается на некий коэффициент (Кp) в результате получаем величину воздействия на систему необходимую для достижения минимального рассогласования. Превышение коэффициентом определенного значения приводит к перерегулированию которое может быть полезным в случае движения в одном направлении-уменьшается рассогласование в следующем шаге, а в случае реверса - увеличивается.
К скорости вообще нет смысла привязываться, так как для сима величина бесполезная. Важны положение в пространстве (наклон) - статические ощущения, ускорение - для ощущения динамики и ,я думаю, третья производная координаты, возникающая из-за люфта в шарнирах, неоднозначного момента инерции, вызывающая дискомфорт - тошноту, головокружение.
С положением в пространстве проблем нет - обратная связь по датчикам. С ускорением в принципе тоже, при условии что момент инерции и масса константы. А вот третья производная ни как пока не оценивается.
В идеале регулятор (контроллер) должен на выходе выдавать такое значение воздействия чтобы:
1 рассогласование было минимальным и не зависело от момента инерции
2 третья производная координаты (скорость ускорения, толчек) не превышала определенного значения.
(Добавление)
Рассогласование. В случае кинотеатра - картинку пускаем чуть позже, тем самым уменьшаем рассогласование. А в симе? Думаю к П регулятору нужно добавить интегральную составляющую. ПИ регулятор быстрей чем П. Интегральная составляющая, как бы оценивает тенденцию изменения ошибки, "предугадывает" положение в следующем шаге. Величина этого "предугодания" коэффициент Ki.
Не зависимость от момента инерции. Настраиваем сим на максимальную допустимую нагрузку без перерегулирования. А дальше как то оценивать перерегулирование которое может возникнуть при изменении нагрузки и вносить поправку в Kp(Ki) ???
Третья производная. В каждом шаге рассчитывать и если меньше(больше) заданного значения, то уменьшать (увеличивать) воздействие. Как рассчитать. В памяти держать последние 3 координаты и с учетом заданной (4 координаты) считать изменение ускорения. Но тут лажа со сменой направления. Считать как то по модулю???
Остается еще один важный фактор - это "правильность" передаваемых координат которые скрывают в себе информацию о перегрузках, но туда я еще не лез.
ПС я везде так много говорю - болтун я, вы скажите если что...
Пропорциональные и прочие ПИД регуляторы прёдназначены совсем для других целей - достичь нужной позиции и остановиться там. Наша задача совсем другая - достичь цели с нужной скоростью. Для обеспечения непрерывности движения.
Насчет ощущений ты не прав. Мы чувствуем не положение, а силы, то есть ускорения. И для этого управление по законам динамики идеально.
taran_ob писал(а):
я везде так много говорю - болтун я, вы скажите если что...
В нашем случае - лучше говорить, чем молчать. Я с обоими согласен. В том плане - что меня не устраивает "традиционная" схема регулирования. У меня тоже есть свой взгляд на эту тему, но он еще не сформулировался...
kuzevan писал(а):
Выходом может быть предсказание будущей координаты по текущей координате и скорости
Вот для этого и придумали ПИД регуляторы, чтоб предсказать и быстро отреагировать. В пропорциональной составляющей мы определяем мгновенную скорость как разность текущей и полученной координаты (рассогласование) в единицу времени (период расчета ПИД) умноженную на пропорциональный коэффициент. В следующем периоде она уже будет другая, в результате имеем движение с ускорением повторяющее ускорение принятое в виде координат.Начальная скорость для расчета нам не нужна, потому чо в каждом периоде она уже есть физически. Нарисуй график произвольного движения и разбей его на короткие участки времени...
kuzevan писал(а):
Пропорциональные и прочие ПИД регуляторы прёдназначены совсем для других целей - достичь нужной позиции и остановиться там.
Правильно, оставаться на месте если нет другого задания, по этому мы и должны (в идеале) получать новое задание в каждом периоде расчета шим. На практике это подтверждается степ дир ПИД сервоконтроллером. Не смотря на то что управление происходит дискретно, шагами, вал двигателя вращается плавно без рывков и в случае резкой остановки происходит не большой перелет для компенсации которого используют энкодеры с большим разрешением. Если бы твое утверждение было верным ни кто бы не стремился менять шаговики на серво.
kuzevan писал(а):
Наша задача совсем другая - достичь цели с нужной скоростью.
Абсолютно не противоречит сказанному выше, но акцент не нужно делать на скорости. Нам нужно быть там где говорит игра. Я сказал
, расшифрую - оказаться в заданной точке как можно быстрее. Ведь если мы стремимся к минимальному рассогласованию, скорость стремится к 0. Если мы уже находимся у цели скорость должна быть 0!taran_ob писал(а):
1 рассогласование было минимальным и
kuzevan писал(а):
Насчет ощущений ты не прав. Мы чувствуем не положение, а силы, то есть ускорения. И для этого управление по законам динамики идеально.
Не понял в чем я не прав. Я сказал что важны ускорение для ощущения динамики и положение в пространстве - если мы на вираже сидим под углом это же интересно. По этом в симе нужно двигать жопу, ведь центр масс практически там. А чтоб не насиловать вестибулярный аппарат нужно контролировать третью производную.
А о скорости в симе говорить нет смысла так как величина не ощутимая.
kuzevan писал(а):
Про болтуна пишет не kuzevan.
Извини, уже поправил
taran_ob писал(а):
Нам нужно быть там где говорит игра. Я сказал
Забыл добавить в начале фразы "Хау" Насколько я помню, настоящие индейцы именно так выражаются
taran_ob писал(а):
оказаться в заданной точке как можно быстрее.
Позволю себе не согласиться. Не надо оказываться в заданной точке как можно быстрее. Нужно в ней оказаться к нужному моменту времени...
kuzevan писал(а):
Наша задача совсем другая - достичь цели с нужной скоростью. Для обеспечения непрерывности движения.
вот-вот-вот. И я того же мнения.
kuzevan писал(а):
Действительно, координату получаем, когда она уже должна быть отработана. Но другой у нас нет. Выходом может быть предсказание будущей координаты по текущей координате и скорости и стремление к ней.
Предлагаю упростить задачу. Давайте к моменту прихода новой координаты достигнем предыдущей. Тогда мы сможем полностью повторить огибающую (профиль дороги!?!) из игры с задержкой всего в ОДИН период передачи данных. При периоде передачи = 10 мс мы будем отрабатывать данные из игры с задержкой 10мс. Что-то не подсказывает, что это совсем несущественная величина.
Я предлагаю следующую схему - при получении новой координаты рассчитывать скорость перемещения = (X(n) - X(n-1)) /T и заставлять двигатель перемещаться к новому заданию с заданной скоростью.
Таким образом нужен регулятор, позволяющий двигать ось с ЗАДАННОЙ скоростью. В не зависимости от НАГРУЗКИ на ось. Что-то мне подсказывает, что идеальным решением для данной задачи как раз будет уже предлагаемый тут драйвер STEP/DIR вместе с шаговым движком.
Ale писал(а):
Позволю себе не согласиться. Не надо оказываться в заданной точке как можно быстрее. Нужно в ней оказаться к нужному моменту времени...
Как это, к какому моменту? Ведь игра не знает наперед о наших действиях! В момент получения координаты мы уже опоздали!
taran_ob писал(а):
Как это, к какому моменту? Ведь игра не знает наперед о наших действиях! В момент получения координаты мы уже опоздали!
Так я и предлагаю не забегать на перед. А отстать от игры на один период. Т.е. получить позицию, рассчитать скорость (исходя, естественно, из более менне постоянного периода передачи) и ехать к этой точке, что бы к МОМЕНТУ прихода следующей координаты как раз достичь предыдущей
Шаговик для этого бы подошел, но я не уверен, что он потянет эти частоты. И вообще, мне кажется, шаговый двигатель - тупиковый вариант.
Никого цитировать не буду, нет смысла.
Только скажу что все зависит от мощности двигателей. Если двигатель фуфло он и в Африке фуфло. Если движок не может переместить большой вес относительно своей мощности, тогда вы нечего с этим не поделаете. Если решите проблему с настройкой МК тогда вылезут проблемы с реакцией симулятора. Получается замкнутый круг.
Если вам нужно дешевый вариант и качество обработки в первую очередь обратите внимание на крутной момент двигателя и правильное размещение центра равновесия.
Своего сима еще не собрал жду доставки автокресла которое уже везут 3 месяца этим и не могу подтвердить правильность хода мыслей симостроителей но
все таки, всякие ощущении цитирую своими словами (подвесает форум после каждого ответа учасников. потому не могу дословно процитировать) остановка автобуса производит к дизереонтацыи и тому подобные ощущение это наверное скорее всего проблемы с вестибулярным аппаратом. За четыре года поездок в автобусе на работу не замечал такого. А в общем все дополнителные ощущение можно получить при правильной настройке софта который преобразовывает данные от игры в перемещение.
kuzevan писал(а):
Двигателем не удается управлять по скорости. Мы не умеем ее задавать и измерять.
Шаговик для этого бы подошел, но я не уверен, что он потянет эти частоты. И вообще, мне кажется, шаговый двигатель - тупиковый вариант.
Стоп-стоп-стоп. Что за упадническое настроение? Что значит - не умеем? Задавать - нет вопросов. Измерять - опрашиваем датчик положения и делим разницу позиций на время. Мы зачем вообще тут собрались? Ставить задачи, обсуждать их и решать.
Я прекрасно понимаю, что СТОЯЧИЙ мотор мгновенно не приобретет нужной скорости. И вообще - изменение скорости процесс энергоемкий и не кратковременный. Но если мы ХОТИМ в точности повторять профиль трассы (а мне кажется как раз к этому надо стремиться), мы не должны ставить задачу достичь следующей точки с максимальной скоростью и там остановиться, ожидая очередного задания. Кстати, сейчас вся ситема именно на это и заточена, как впрочем и классический ПИД. В результате на быстые изменения позиции система не может отреагировать в силу инерционности, а на медленные - доезжает и останавливается... Оно нам надо?
Поэтому я не стал бы так пренебрежительно и безосновательно отзываться о шаговиках
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
С редуктором можно по комбинировать. Уменьшит передаточное число и увеличить крутной момент.
kuzevan писал(а):
О шаговиках я не отзывался пренебрежительно, напротив, я их люблю. Просто сомневаюсь, что они тянут эти скорости.
Давай прикинем. Из опыта общения на форумах я для себя выяснил, что перемещение от нижней точки оси до верхней должно занимать порядка 1 секнды на максимальной скорости. Пусть я ошибся и мы усложним задачу - 0.5 секунды. Для движителей с "замедляющими" редукторами это перемещение равно половине оборота вала редуктора - 180 градусов. Редукторы применяются обычно с передаточным числом 25. Итого - Один оборот редуктора в секунду = 25 оборотов в секунду для вала шаговика. Ну а дальше надо смотреть - сколько шагов на оборот. Если 200, то максимальная частота следования импульсов на обмотки составляет 5000 Гц (25*200). Цифра не выглядит фантастической. Мы мостом качаем 20 кГц. Насколько я помню, есть шаговики и с меньшим кол-вом шагов на оборот.
Если я ошибаюсь, поправь меня.
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 писал(а):
Я предлагаю следующую схему - при получении новой координаты рассчитывать скорость перемещения = (X(n) - X(n-1)) /T и заставлять двигатель перемещаться к новому заданию с заданной скоростью.
Блин, так мы говорим об одном и том же!!! (X(n) - X(n-1))-это рассогласование (мгновенная скорость). Только на Т делить не надо так как это константа-период интегрирования (или период расчета шим, в идеале должно быть и периодом приема данных, в общем называйте как хотите), входит в коэффициент пропорциональности, который тоже константа при постоянной массе игрока. А это и есть наш Kp, который "обеспечивает" пропорциональность мгновенной скорости и величины ШИМа для обеспечения этой скорости.
(Добавление)
Ale писал(а):
если мы ХОТИМ в точности повторять профиль трассы (а мне кажется как раз к этому надо стремиться)
ну скорей не профиль трассы, а положение авто в пространстве
Ale писал(а):
мы не должны ставить задачу достичь следующей точки с максимальной скоростью и там остановиться, ожидая очередного задания . Кстати, сейчас вся ситема именно на это и заточена
А этого ни кто и не требует, да это и не возможно ввиду инерционности системы и малого периода приема координат. Мы всегда будем опаздывать, если не будет перерегулирования. А вот чтоб не было перерегулирования, при максимальной динамике нужно добавить интегральную составляющую, увеличивать быстродействие всей системы. Ты сам себе противоречишь, говоря, что нужно повторить профиль трассы и при этом не делать этого быстро. Зачем нам профиль потом, когда мы его уже проехали?
Ale писал(а):
В результате на быстые изменения позиции система не может отреагировать в силу инерционности, а на медленные - доезжает и останавливается... Оно нам надо?
Думаю что это сейчас происходит из-за того, что период расчета ШИМ на много меньше приема координат, и медленного регулятора (без интеграла и дифференциала).
Ale писал(а):
Кстати, сейчас вся ситема именно на это и заточена, как впрочем и классический ПИД
ПИД заточен на то чтоб в любой момент времени рассогласование параметра было минимальным. А какой параметр - не важно. В нашем случае это координата. И чем чаще и быстрей мы будем ее получать, тем ближе мы будем к истиной траектории без всяких аппроксимаций и додумываний. Зачем нам двигаться если машина не двигается?
И не нужно упрощать задачу, хуже все равно получится...
(Добавление)
CraCk писал(а):
Только скажу что все зависит от мощности двигателей.
Это не панацея, хороший контроллер все равно нужен.
CraCk писал(а):
Если решите проблему с настройкой МК тогда вылезут проблемы с реакцией симулятора.
Пытаемся доказать обратное.
CraCk писал(а):
За четыре года поездок в автобусе на работу не замечал такого.
А если стоять и не держаться за поручни, кто вас в конце остановки дергает, думаете инерция? Она тоже, но больше вы сами.
Ale писал(а):
Давай прикинем. Из опыта общения на форумах я для себя выяснил, что перемещение от нижней точки оси до верхней должно занимать порядка 1 секнды на максимальной скорости. Пусть я ошибся и мы усложним задачу - 0.5 секунды. Для движителей с "замедляющими" редукторами это перемещение равно половине оборота вала редуктора - 180 градусов. Редукторы применяются обычно с передаточным числом 25. Итого - Один оборот редуктора в секунду = 25 оборотов в секунду для вала шаговика. Ну а дальше надо смотреть - сколько шагов на оборот. Если 200, то максимальная частота следования импульсов на обмотки составляет 5000 Гц (25*200). Цифра не выглядит фантастической. Мы мостом качаем 20 кГц. Насколько я помню, есть шаговики и с меньшим кол-вом шагов на оборот.Если я ошибаюсь, поправь меня.
Если возвращаться к степдиру. Я почему сразу на него подумал, потому что системы очень похожи. В симе координата дискретная - это шаг. В чпу главное повторить заданную траекторию и в симе тоже. И степдир ПИД сервоконтроллер в чпу - яркий пример того, что ПИД регулятор хорошо справляется с задачей позиционирования. Просто для понимания ПИД, рассматривать систему сима и чпу нужно не в глобальном масштабе времени, а за период получения нового задания (расчета ШИМ).
Но вот на шаговик, я бы сильно не рассчитывал. Повторю главные недостатки. Шум. Потеря момента на резонансной скорости. Сложное управление - очень чувствительное к помехам. Два Н моста на движок. Скачкообразное вращение на малых скоростях в полношаговом режиме. Положительная стороны. Есть полно готовых решений драйверов. Можно обойтись без редуктора. Максимальная частота шага с приличным моментом около 800 - 1000Гц в полном шаге. При 200 шагах на оборот - 300об/мин.
Ale писал(а):
Посмотрел твои исходники, таки ты не любитель... Признаюсь, по началу я тебе недооценил, и предложил использовать готовое решение пид сервоконтроллера совместно с простым контроллером сима. Но теперь уверен что ты бы смог реализовать, предложенную ранее несколькими участниками форума, конфигурацию: на каждый двигатель по контроллеру (интеллектуальному) прямо к компу. В качестве интерфейса взять rs485. Протокол - практически у тебя уже есть свой (нужно только дописать адресацию в режиме конфигурирования, а в рабочем режиме- широковещание, каждый контроллер забирает свою координату), судя по названым цифрам - шустрый. Кто не знает, 485 интерфейс - это два провода (витая пара с синфазными сигналами) на котором запараллелины все устройства(слейвы) вместе с компом(мастер), интерфейс промышленный - помехозащищенный. Микросхема преобразователь rs232-rs485 и обратно стоит менее 1$ и имеет 8 ног. Контроллер типа мега8 или 88, ну или какой то с аппаратным декодированием энкодера, так как на обработку сигналов с него уходи довольно много процессорного времени. В таком варианте все аппаратные ресурсы микроконтроллера будут предоставлены одному двигателю, что в свою очередь должно повысить быстродействие и расширить возможности - быть универсальным!
Скорость они, наверное, потянут, тут я погорячился, но, думаю, там есть и другие подводные камни.
https://skydrive.live.com/redir?resid=B557CEBDD9406F6D!123
(Добавление)
kuzevan писал(а):
По шаговикам. Они великолепны в ЧПУ, где требуется точное позиционирование, для этого и созданы. Но в динамических задачах, где мы моделируем действительность, мне кажется, обычные двигатели лучше.
Полностью поддерживаю.
(Добавление)
Еще мысль по поводу степдир. Самый большой минус у сервоконтроллера для ЧПУ применительно к симу, как я понял - в качестве параметра регулирования в диф составляющей принимается не координата, как в П и И, а скорость. Для ЧПУ это нужно, для сима - нет. Хотя может на практике и не помешает, сложно представить модель в голове.
Вот код одностороннего воздействия. Проверенный в регуляторе оборотов. Для сима осталось ввести отрицательное воздействие (реверс) и, думаю, в качестве параметра регулирования в диф составляющей нужно задавать [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;}; //проверка предела воздействия }При положительной скорости (движение вверх)
ШИМ=57*А+42,
При отрицательной (движение вниз)
ШИМ=57*A-42.
kuzevan писал(а):
Извините, коллеги, в первом посте я ошибся. Последние две формулы и текст должны выглядеть так:
При положительной скорости (движение вверх)
ШИМ=57*А+42,
При отрицательной (движение вниз)
ШИМ=57*A-42.
Как бы эту теорию проверить???
kuzevan, ты просто не хочешь понять принцип пропорционального регулирования. Любое движение с ускорением можно разбить во времени на движение с постоянной, мгновенной скоростью, которая зависит от шима пропорционально (в идеале). ШИМ=K*((Х-Х0)/t), так как t=const, K=const, то Kp=K/t, следовательно ШИМ=Kp*(X-X0), где Кр-коэффициент пропорциональности, X0 - текущая координата сима, Х - будущая координата сима через время t=const - период интегрирования. Следовательно, если все правильно, то через время t - X0=Х, то есть траектории будут одинаковыми, но с разницей во времени t=const, а это означает что и ускорения в любой момент времени будут одинаковыми.
Ale писал(а):
Как бы эту теорию проверить???
Было бы здорово, чтоб в программе управления была возможность подгрузить семпл - текстовый файл с произвольной траекторией, включающей в с себя максимальные перегрузки. Эту траекторию отображаем на графике одним цветом. Шлем координаты из траектории в контроллер. В ответ на координату, контроллер возвращает текущую координату, по которой программа рисует траекторию другим цветом. Настройка контроллера (всякие коэффициенты) сводится к тому чтоб графики эталонной и реальной траекторий максимально совпадали. При таком подходе, сим сможет настроить и ребенок, не понимающий ни чего в ПИД.
taran_ob писал(а):
желательно иметь ШИМ с большей разрядностью, хотя бы 512.
Сейчас реализован 10-битный шим - 1024 значения. Ограничить - нет проблем
taran_ob писал(а):
Было бы здорово, чтоб в программе управления была возможность подгрузить семпл - текстовый файл с произвольной траекторией
Уже реализовано в отладочной программе xSimCTRL.exe
А что скажешь по поводу rs485, с раздельными контроллерами?
taran_ob писал(а):
А что скажешь по поводу rs485, с раздельными контроллерами?
Нет абсолютно никаких проблем. Но я все еще считаю это избыточным. Самый простой AVRmega имеет на борту ДВА канала аппаратных ШИМ. И уж поверь, расчетных мощностей вполне хватит для реализации ДВУХ даже самых навороченных ПИД каналов. Так что я проголосую за один контроллер на два движка.
А про RS485 - вполне здравая идея. НО требующая доп вложений. На компах такого интерфейса нет. Поэтому по любому придется делать переходник USB-RS на FTDI. Есть несколько путей-
1 - покупка (наверняка есть, я не качал)
2- реализация прямо на плате контроллера, как сейчас есть, но пустить канал 485-й дальше на выход, к которому можно цепочкой подключать следующие контроллеры уже без USB преобрезователей,
3 - изготовление своего преобразователя, автономного, тогда на всех контроллерах вместо USB преобразователя набо будет ставить по две микрухи 485 (на вход и выход)
Ale писал(а):
Самый простой AVRmega имеет на борту ДВА канала аппаратных ШИМ. И уж поверь, расчетных мощностей вполне хватит для реализации ДВУХ даже самых навороченных ПИД каналов.
А как быть если движков 4? Хватит ли мощностей для программной реализации 4ШИМ, 4энкодеров ?
taran_ob писал(а):
А как быть если движков 4? Хватит ли мощностей для программной реализации 4ШИМ, 4энкодеров ?
Стоп. Если 4 движка - ставим 2 контроллера (ты ведь вообще на 4 движка 4 контроллера предлагаешь ). Это во-первых. Во-вторых - контроллер типа mega644 (в дип корпусе) имеет два канала 16-битных ШИМ (мы из них делаем 10-бит) + два канала 8-битных ШИМ. А вот контроллер mega64 в корпусе tqfp-64 - уже 6 каналов аппаратных 16-битных ШИМ. Но плату под его в домашних условиях трудно изготовить. Я себе сделал, но я на заводе заказываю.
Так что на atmega64 ресурсов хватит и на 4 канала.
1 ЛУТом сделать 4 одинаковые, маленькие платки, скажем с мега8 или вообще с тини2313 если отказаться от аналоговых датчиков, гораздо проще чем одну с монстром с 64 ногами.
2 У меня есть отрицательный опыт в управлении несколькими мощными индуктивными нагрузками от одного МК. Считаю, что гальванически развязывать мосты друг от друга нужно обязательно. Да это и удобно, потому что найти блок питания, скажем, на 800 Вт для 4х движков сложнее чем 4х200 Вт. При реализации управления от одного МК придется ШИМить через оптроны, а это не совсем правильно. А если появится необходимость в обратной связи по току - вообще труба. Проще и правильней развязать rx232.
3 Написать программу МК для управления одним двигателем проще чем для 4х.
4 С разделением - конструкция становится модульной, что тоже +.
/*
Программа управления одним двигателем
от управляющей программы 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 дала такую картинку:
Заметно, что значения ШИМ почти всегда занимают крайние положения, запаса по мощности нет, можно, даже, релейное управление применять.
Если кто-нибудь потестит, прошу отписаться.
kuzevan писал(а):
Программа Ale дала такую картинку:
Это картинка с реального мотора под нагрузкой?
kuzevan писал(а):
Выкладываю программку для Ардуино управления двигателем.
Очень-очень интересно. Ардуинка есть, возможность потестить тоже, исходников от Ale нет.
Можно сразу вариант с прошивкой с описанием ног?
AlexVr писал(а):
исходников от Ale нет.
Пришлю... Скажи куда? (в личку)
А ноги Ардуинки я любые подпаяю!
Alex-vr@ya.ru
AlexVr писал(а):
Только мне бы вариант готовой прошивки, а то я накозявлю с программой
А ноги Ардуинки я любые подпаяю!
Нее. Я тебе пришлю исходники для платы AMC1.5. Других у меня нет. По поводу прошивки для ардуины - это к kuzevan. Но насколько я знаю, ты можешь срисовать с сайта тот код, который он прислал, и вставить его в скетч. Откомпилировать и загрузить в ардуину. Или я не прав?
kuzevan писал(а):
Выкладываю программку для Ардуино управления двигателем.
Хм... Не нашел в тексте где присваивается хоть какое нибудь значение переменной pwm_d.
Тем не менее на вывод ты ее отправляешь
kuzevan писал(а):
ToString(4,outputString+7,pwm_d+255);
И кстати, на могу найти логики в прибавлении 255-и.
ШИМ у меня изменяется от -255 до 255, я не был уверен, что отрицательные значения отображаются корректно и прибавил 255.
Про ноги напишу завтра и завтра, наверное выложу программу измерения параметров двигателя.
kuzevan писал(а):
Хмм... Описочка вышла, правил перед отсылкой и поспешил. Там просто pwm надо.
.Тщательнее надо, товарищ (С)
kuzevan писал(а):
ШИМ у меня изменяется от -255 до 255, я не был уверен, что отрицательные значения отображаются корректно
Должно корректно отображаться... Попробуй...
kuzevan писал(а):
Заметно, что значения ШИМ почти всегда занимают крайние положения, запаса по мощности нет, можно, даже, релейное управление применять.
Чтоб улучшить динамические характеристики привода, можно запитать его повышенным напряжением, скажем 24В и при этом ограничить шим до 50%. За счет повышения напряжения ток в обмотках двигателя будет наростать быстрее, а следовательно и момент.
taran_ob писал(а):
Чтоб улучшить динамические характеристики привода, можно запитать его повышенным напряжением, скажем 24В и при этом ограничить шим до 50%.
Мысль оригинальная, но не понял как от этого повысится напряжение .... разъясни пожалуйста если не сложно
taran_ob писал(а):
Чтоб улучшить динамические характеристики привода, можно запитать его повышенным напряжением, скажем 24В и при этом ограничить шим до 50%.
Имхо, динамику разгона можно будет увеличить в таком случае только, если на некоторое время давать ПОЛНЫЙ шим, а только потом свяливастья на безопасные 50%. Иначе никакой разницы не будет. Обмотка ШИМ интегрирует и превращает 50% от 24 В в привычные 12 В.
/*
Программа диагностики мотора
Вход:
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, пока значения не начнут повторяться.
Исправлена ошибка, обнаруженная глазастым 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 писал(а):
Про ПИД я все сказал ранее, добавить нечего.
не смотря на то что ты не поддерживаешь ПИД, в своем алгоритме подобие ПИ сам реализовываешь не осознано...
kuzevan писал(а):
Объясняю в последний раз.
Подожди, не нервничай. Что же, ты хочешь, чтоб все сразу восприняли твой подход? Или код ты выложил для принятия к сведению?
У меня какое то полное недопонимание...
kuzevan писал(а):
Все пропорциональные системы управления так и называются, потому, что управляющий сигнал (ШИМ) пропорционально зависит от расстояния до цели. Чем это расстояние меньше, тем меньше сигнал. Для того, чтобы подойти к цели и остановиться.
100% верно. Все это справедливо в случае если период получения координат намного больше периода расчета шим. На столько больше, что ко времени получения следующего задания, шим проинтегрируется до 0. А речь идет о том, чтоб от задания до задания двигаться с постоянным ШИМ(пропорциональным), и как следствие с постоянной скорость(мгновенной). А так как время между заданиями ооочень маленькое, то ускоренное передвижение сима за какое то время будет состоять из маааленьких передвижений с постоянной скоростью.
И где же здесь остановка???
Мало того, повторюсь, я записал на листике твое выражение для PWM, подставив в него V0 и ACC и в результате получил выражение ооочень похожее на ПИ закон только со своими, пока не понятными мне, коэффициентами k1 k2 1,5 2.
kuzevan писал(а):
Я останавливаться не собираюсь, поэтому мой сигнал не зависит от расстояния до цели, следовательно моя система не пропорциональная.
Как это не зависит от расстояния до цели, если в твое выражение PWM ни чего не входит кроме координат. То что ты их разности обозвал V0 и ACC это ни о чем не говорит. И по графику видно как ты в траекторию попал замечательно. Так что очень даже пропорциональная...
Есть у нас задание. Любое. Нагреть воду в котле до 99 градусов за 2 часа, но не до 100, чтобы не закипела. Включаем нагреватель и периодически сравниваем температуру воды с заданной. Чем ближе к 99 градусам, тем ниже подаем мощность на нагреватель. За час нагрели и держим. Подостыла - чуть-чуть греем, нагрели - выключаем. Это пропорциональный регулятор, его цель - 99 градусов, период - 2 часа.
Теперь о нас. Пришел сигнал с новой целью, следующий поступит через 33 мсек. Включаем мотор. Внутри этих 33 мсек мы имеем несколько внутренних циклов, в которых измеряем расстояние до цели, если оно близко, уменьшаем ШИМ. Допустим, достигли цели за 20 мсек. Выключаем мотор. Стоим, ждем новой цели. Это тоже пропорциональный регулятор, точно такой же, как для воды.
Я поступаю совершенно иначе. При поступлении новой цели я вычисляю по простым формулам механики ускорение (и ШИМ), которые должны обеспечить прибытие в заданную цель через заданное время 33 мсек. И подаю этот ШИМ на двигатель. Внутри этого цикла я ничего не измеряю и не корректирую, просто жду новой цели. Зависит ли этот ШИМ от расстояния до цели? Конечно. Зависит ли от начальной скорости? Конечно. Но это совсем не означает, что это пропорциональный регулятор, не надо путать термины.
Еще раз. Внутри цикла у меня никаких коррекций нет, а это краеугольный камень пропорционального регулирования. А приходит новая цель - это новая работа.
А тебе, для домашнего задания, предлагаю написать программку управления через ПИД и потестить ее, это лучше, чем флудить своим ПИДом.
Мою-то можно потестить, а как известно - практика - критерий истины.
kuzevan писал(а):
Теперь о нас. Пришел сигнал с новой целью, следующий поступит через 33 мсек. Включаем мотор. Внутри этих 33 мсек мы имеем несколько внутренних циклов, в которых измеряем расстояние до цели, если оно близко, уменьшаем ШИМ.
Ну, так я же предлагаю не иметь!!!! внутри этих 33мсек никаких внутренних циклов. Соответственно ШИМ уменьшаться не будет! Но лучше, чтоб это были не 33мс, а по меньше.
kuzevan писал(а):
А тебе, для домашнего задания, предлагаю написать программку управления через ПИД и потестить ее, это лучше, чем флудить своим ПИДом.
всему свое время...
kuzevan писал(а):
При поступлении новой цели я вычисляю по простым формулам механики ускорение (и ШИМ), которые должны обеспечить прибытие в заданную цель через заданное время 33 мсек.
Если ты в эту формулу учтешь внешнее воздействие, то в результате самостоятельно выведешь закон ПИД регулирования
kuzevan писал(а):
Выкладываю исправленную и дополненную версию программы для Ардуино управления мотором.
Загрузил, подцепил резистор, запустил прогу от Ale - РАБОТАЕТ!kuzevan, мои поздравления!
Программа Ale, после выставления компорта 3 на галочках прием, передача зависает и не отвечает.
При повторном запуске все хорошо, график от датчика рисует.
Диод только 1 из 2 на мосту при перемещении ползунка в программе помигивает, на индикаторе частотника направление только в одну сторону и не меняется, хотя задание в обе стороны рисуется на графике.
При нажатии "Пуск" на частотнике программа повисает. При дальнейшем перезапуске пишет, что порт не отвечает.
Резет на Ардуинке не помогает, лечится только переподключением по USB.
Появилось минутка на домашнее задание . Но проверить пока не на чем, Ардуино у меня нет, а над макетом я работаю. Просьба. Не мог бы ты потестить, если время будет? Нужно в твой код вставить одну функцию и по ней вычислять 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;}; //если воздействие за приделами, возвращает придельные значения
}
kuzevan писал(а):
Введена защита от дергания мотора в состоянии покоя.
Побороть дергание можно, подавая на каждое плече моста одинаковый шим но с инверсией. Это немного уменьшит максимальную скорость, но привод будет, как бы, будет поджат с двух сторон - уменьшается инерционность.
taran_ob писал(а):
Побороть дергание можно, подавая на каждое плече моста одинаковый шим но с инверсией. Это немного уменьшит максимальную скорость, но привод будет, как бы, будет поджат с двух сторон - уменьшается инерционность.
Не понял ? Пожалуйста подробней. Я использую полумост (как и большинство) - т.е пока первое плечо активно (ШИМ), второе в нуле. Смена полярности - первое плечо в нуль, на второе - ШИМ. Схемотехнический на каждое плечо моего полумоста ШИМ подать нельзя.
А дерганье в состоянии покоя рождается из шумов, выводящих схему из состояния покоя, ИМХО
В твоем мостике можно это реализовать изменив логику микрухи и-не.
Ale писал(а):
А дерганье в состоянии покоя рождается из шумов, выводящих схему из состояния покоя, ИМХО
и из-за инерционности и медленного регулятора, имхо
taran_ob писал(а):
В твоем мостике можно это реализовать изменив логику микрухи и-не.
Это уже будет ПОЛНЫЙ мост. Далеко не все могут изменить логику работы на готовых изделиях (на том же Pololu)... Заметь, я не говорю, что полный мост - это плохо
Но иногда, а именно в нашем случае, по причине очень слабого мотора дергания могут быть значительны. объясню смысл коэффициентов К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, ты мотор тестил?
А Тарану отвечу, только после вас. Сначала сам свою программу потесть, потом мне присылай, готовую.
Если бы на контроллер поступала бы не только следующая координата, но и скорость в ней, то его работу можно было бы значительно улучшить.
Цикл 33 мсек надо разделить пополам. В первую половину - разгоняемся, во вторую тормозим, так, чтобы достигнуть нужной координаты с нужной скоростью. Параметры разгона и торможения рассчитать легко, но нужно знать скорость. Раз уж Ale строит свою программу, попросим его ввести такую опцию?
Например, вместо AB FF s1 s2 передавать FF s1 s2 v1 v2.
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)!!!
kuzevan писал(а):
Если бы на контроллер поступала бы не только следующая координата, но и скорость в ней, то его работу можно было бы значительно улучшить.
Конечно, ты же пытаешься строить параболу , а так в системе координат скорости от времени парабола станет прямой, от этого и тебе и легче...
Это на много все усложняет, координаты достаточно, но передвигаться нужно маааленькими шажочками по отрезкам вдоль параболы, никто этого не заметит, чеснослово...
kuzevan писал(а):
AlexVR, ты мотор тестил?
не могу. выше написал почему.
AlexVr писал(а):
При нажатии "Пуск" на частотнике программа повисает. При дальнейшем перезапуске пишет, что порт не отвечает.
Резет на Ардуинке не помогает, лечится только переподключением по USB.
Признаки "искрения" по земле. Бывает включение люминесцентной лампы вышибает USB с FTDI. На корпусе большого компа как правило 110 Вольт (такой у них фильтр по питанию, на емкостях делится переменное сетевое напряжение). Именно поэтому я свои девайсы стараюсь "опто-развязать".
Включать программу Ale лучше осторожно, сначала включение приема, потом включение передачи, потом двигаю позицию вручную, убеждаюсь что мотор отслеживает вход, потом включаю генератор. Выключаю в обратной последовательности.
Программы что Ale, что Ардуино виснут на глушняк, с последующей ошибкой порта.
Ардуино получается закрыть только через контрл-альт-дел. А порт восстанавливается только через пару минут методом вкл/выкл через USB.
Все это при включении "Пуска" на частотнике в любой последовательности.
Вывод: Ардуинка и мой частотник по нынешней схеме - несовместимы
Эхх..., а у меня на Ардуинку столько надежд было...
AlexVr писал(а):
Перепробовал все последовательности включений по 2 раза.
Вывод: Ардуинка и мой частотник по нынешней схеме - несовместимы
Эхх..., а у меня на Ардуинку столько надежд было...
В принципе не все так плохо. Я рекомендую просто провести доработку - отвязать контроллер от силовой части. Цена вопроса - 4 микросхемы 6n135.
Во-первых, я не понял, что такое частотник.
Во-вторых, AlexVr, включал ли ты сервисную программу?
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
Связка "частотник+асинхронный двигатель" используется вместо связки "мост+двигатель постоянного тока"
kuzevan писал(а):
Как я понимаю, все претензии, как к автору программ должны быть ко мне.
Претензий на этом сайте быть не может. Принципы социалистические, финансовых выгод не предусматривающие
kuzevan писал(а):
Во-первых, я не понял, что такое частотник.
вот моя платформа
сейчас использую вот такой мост:
http://fotki.yandex.ru/users/alex-vr/view/583421/
kuzevan писал(а):
Во-вторых, AlexVr, включал ли ты сервисную программу?
Я описал попытки выше. Под "Ардуино" я имел в виду софт.
Ведь сервисная программа работает на его базе.
http://yadi.sk/d/GAZQ95yo1AP4m
Перед использованием, прочтите приложенный ReadMe файл.
Принципиально мало чем отличается от того, что было раньше, просто управление мотором упаковано в класс CMotor.
Но есть одно, маленькое отличие. Дело в том, что в контроллере есть две системы единиц положения, входная (0-255) и внутренняя, потенциометра. В старой программе для одного двигателя я использовал входную, пересчитывая значения потенциометра.
В новой программе я взял за основу единицы положения потенциометра, во-первых пересчитывать не надо, во-вторых точность возрастает в два с лишним раза.
В связи с этим, возникли и новые коэффициенты, вместо K1 и K2 - KP1 и KP2. Пришлось переделать и сервисную программу, теперь она измеряет те и другие коэффициенты.
http://yadi.sk/d/GAZQ95yo1AP4m,
была скачана 5 раз.