Добрался до сервомашинок

Некоторое время назад привезли мне парочку дешёвых сервомашинок SG90 с DX. Заказывал просто поиграться и посмотреть что это за сервомашинки, о которых все пишут)

Вот, наконец-то и дошли до них руки.

Заюзал для управления тиньку.

подключение

Ещё стоял LC-фильтр на питании сервомашинок, но дроссель оказался очень уж хлипким и не выдержал ток который жрали сервы. Пришлось его выкинуть)

Вообще, про управление сервами уже писал Ди. Особенно добавить нечего.

Вкратце, сервомашинка управляется импульсами определённой длительности, следующими с некоторым интервалом.

управление сервомашинками

Картинка нагло спёрта с EE, ибо свою такую же рисовать лень)

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

Для генерации импульсов я заюзал Таймер1, по одному каналу на сервомашинку.

/*
 * Запуск.
 */

OCR1A = 800u*20; // длительность импульса в тактах часиков
OCR1B = 800u*20; // 20тактов = 1мкс (на тактовой 20 мгц)

TCCR1B = 1<<CS10;                 // пусть тикает каждый такт
TCNT1 = 0;                        // сбрасываем счётчик
PORTD |= (1<<PD4)|(1<<PD5);       // включаем выходы
TIMSK |= (1<<OCIE1A)|(1<<OCIE1B); // когда досчитает, будет прерывание

/*
 * Ловим прерывания.
 */

// когда досчитает, выключаем выходы
ISR(TIMER1_COMPA_vect) { PORTD &= ~(1<<PD4); }
ISR(TIMER1_COMPB_vect) { PORTD &= ~(1<<PD5); }

// когда дойдёт до верха, запрещаем прерывания
ISR(TIMER1_OVF_vect) { TIMSK &= ~((1<<OCIE1A)|(1<<OCIE1B)); }


Нуу не оч красивый код, юзающий целый Таймер1. Зато прерывания получились очень короткие (чтобы не потерять USB-фрейм, пока они будут выполняться).

Вот такую платку сделал.

картинко

Ага, всё заляпано. Отмывать влом, да и хз чем (

картинко

А вот это вообще без комментариев )))

картинко

картинко

Сначала закрепил камеру вверх ногами. Когда переворачивал, сковырнул с платы какой-то кондёр. Вроде и фиг бы с ним, но камера стала оч плохо определяться компом. Пришлось разобрать такую же вебку и померять ёмкость этого кондёра) Потом пришлось оч долго запаивать кондёры в обе камеры, ибо во-первых, мелкие и во-вторых, фиг подлезешь. В конце концов, с феном и матюгами удалось поставить)

Данную конструкцию хотел поставить себе на сайт. Но, вот, роутер, который выполнял функцию сервера, совсем не вовремя решил сдохнуть. В общем, демка отменяется (

Вот маленькое видео.



UPD: И да, чуть не забыл)

USB incompatible

UPD2: Добавил бинарник под mipsel-linux-ulibc.
Файлы в топике: usb-servo-controller.zip

Комментарии (28)

RSS свернуть / развернуть
Шустрик)
0
Хе-хе, USB )
А почему на плате три хедера? Под три сервы?
Сервы не дрожат? Я подключал одну такую к пинборду, с кодом дихальта из статьи, откуда картинко — они постоянно жужжали, подергиваясь возле заданного положения. Хотя возможно это связано с нестабильностью импульсов или шумом АЦП.
А вот это вообще без комментариев )))
Жесть)
Но, вот, роутер, который выполнял функцию сервера, совсем не вовремя решил сдохнуть.
Вроде ж опять заработал?

А что за вебка?
0
  • avatar
  • Vga
  • 24 мая 2011, 21:40
  • ↓
1. Три хедера просто потому что 3 свободных ножки оставалось у тиньки
2. Совсем не дрожат) Даже несмотря на срабатывание прерывания USB (специально флудил шину). Но тут они от USB напрямую питаются. А когда стоял хлипкий дроссель, страшно елозили туда-сюда. Видимо, внутреннее сопротивление ИП оч сильно на них влияет)
3. Виснет через несколько минут работы(
4. Вебка средней паршивости, A4-Tech PK-750MJ. Корпус выкинул чтобы облегчить. Кстати, там интересный чип стоит, VC0332. Хотел поковырять его когда-то. Но китайцы шит не дают. Спрашивают про партию и прочую фигню) Будто я сэмплы хочу заказать а не шит)
0
2. Видимо, таки шумы АЦП и прыгание фронтов (у Ди на таймерах РТОС сделано).
3. А питание не проверял?
4. Они, сцуко, такие. Хотя корейцы из самсуя вообще NDA за даташит требуют подписать.
Кстати, девайс на термосоплях собран? Неаккуратненько) И еще они любят со временем терять адгезию и отваливаться. Если, конечно, не заливать так, что оно и без адгезии никуда не денется. Да и вообще недолюбливаю на клей собирать. Винтики обычно надежней)
0
Проверял я питание. Нагрузил БП лампочками примерно на 1 ампер. Напряжение как было 5,2в так и осталось.
Впринципе, у мя ещё такой питальник есть. Можно попробовать от него запитать)

Под термоклеем ещё проволочками примотано) А неаккуратно, это да) Не дружу с механикой совершенно((
0
Внутреннее? Там явно один импульсник внутри стоит.
0
Хм, внутреннее не смотрел. Мне казалось там всё напрямую. Щас повнимательней гляну.
0
Ага, стоит DC-DC на 3,3в. Подключил нагрузку на 100ма — напряжение стабильно. В общем, оставлю пока другой БП, посмотрим как поведёт себя)
0
А в моем — целых два. Зато USB нету. После ковыряния ADSL четырехпортовика (где через полгода вздутый кондер коротнул питание) — заблаговременно запасся электролитами к ним :)
Кстати, нне так уж он плох, D-Link. По крайней мере после устранения КЗ заработал как ни в чем не бывало.
0
Там мог быть джиттер изза таймера диспетчера. Надо осцилом смотреть. Либо просто серва не очень качественная. У меня одна HS311 сама по себе жужит, видать голимый внутри стоит переменник.
0
А похоже ты прав насчёт питания)
Вот сейчас от другого БП работает уже довольно долго, и всё впорядке.

Сейчас родной блок питания разобрал молотком. Визуально всё впорядке. Хм…
0
Сейчас родной блок питания разобрал молотком
Так вот ты какой, северный олень…

Ну тут надо его нагружать (желательно на регулируемую нагрузку) и смотреть как он себя ведет при ее изменениях, и осциллографом на предмет помех потыкать. Сжечь флайбэк обычно довольно сложно — у него принципиально ограничена передаваемая мощность.
0
Кстати, совсем забыл. Проверять там надо не выходную характеристику, а пульсации на выходе под нагрузкой и особенно — под нагрузкой импульсной. А то при издыхании электролитов БП на низких частотах работает как CV (там, где успевает ОС отработать), а на высоких — уже как CC. Естественно, тут-то крышу процессору и сносит.
Ну и во внутреннем питальнике электролиты тоже поменять пользительно. В порядке профилактики.
0
Померять пульсации — проще сказать, чем сделать. )
А кондёры ведь нужны не абы какие? По каким параметрам их выбирать для импульсного БП?
0
Ну, при наличии осциллографа — без проблем. Без него… тут сложнее) Хотя можно попытацо померять напругу через кондер, или подрубить через него же наушник и послушать, как оно реагирует на нагрузку)
По идее да, нужны low ESR. Но когда я их попросил в промэлектронике — сказали нету.Так что обычные буржуйские электролиты, желательно приличных фирм. Вот, на каком-то форуме по ремонту БП нашел табличко:

У нас продаются CapXon, Jamicon, их и ставлю. Работают.
0
о. так может мой сип-телефон линксис помер такой же смертию? после грозы перестал видеться веб-интерфейс, а сам телефон перестал реагировать на комбинацию жесткого сброса…
0
А вот ему скорее прилетело по линии. Впрочем, можно же проверить, воткнув заведомо нормальный БП.
0
по эзернету от адсл модема? при этом сам модем продолжил жить?
там по-моему какое-то хитрое гнездо с необычным диаметром было. вроде находили на рынке подобный блок питания, и та же фигня, но никто не знает, насколько качественным был этот бп…
вообще порыл инфу по тому телефону — выяснилось, что в нем кодирование осуществлялось на видеочипе…
0
Тогда да, врядли. Можно расколупать блок и временно забрать его шнурок. Запитать от лабораторника. Или разобрать телефон и подпаять хвост от лабораторника/другого-доверенного-блока внутрь.
0
аа!!!
hex файла нетути! а сделай, плиз, бинарник для опенврт?
0
Аха, собрал. :)
0
Хе, какая пепяка.
Я этими сервами по проще рулил — аппаратным 16 битным шимом, с этой же тиньки.
0
ура-ура!
подобную конструкцию придется вскоре собирать для своего пенолета)

а теперь куча вопросов:
роутер виснет от такой небывалой нагрузки? или после очередного софтверного апгрейда?
почему usb incompatible?
куда подключалось все это безобразие на видео?
каким оказалось энергопотребление моторчика в момент поворота и в уже стабилизированном состоянии?
0
Роутер сгорел после втыкания в него слишком прожорливого (или кривого) хаба. Подробней — в посте «Спокойной ночи».
Инкомпатибл потому, что за налепление этого логотипа на свой девайс нужно хорошо отстегнуть разработчикам USB. За VID:PID вообще-то тоже, но…
Подключалось, судя по стуку клавиш, к компу.
0
я могу стучать клавишами на компе в окне терминала :-) так что судить следует, скорее, по вложенным файлам… впрочем, они тоже указывают на комп.
странно, что все это проявляется таким хитрым образом — то сглючит, то не сглючит… стабилизатор (в вашем обсуждении чуть выше в этом посте) — это в самом блоке питания? По-моему в дир-320 на usb питание идет непосредственно от БП (хотел бы я управлять им программно)

По ссылке отличный прибор, я заценил :-)
0
А пока никто не знает, что именно сдохло в роутере. Стабилизатор там есть как в питальнике (свежие поделки дилинка комплектуются импульсными адаптерами на 5), так и в самом роутере (3.3В).
(хотел бы я управлять им программно)
Поставь в разрыв +5В на порт ключ, подключи его к подходящему GPIO (скажем, вместо какого-нить ненужного светодиода), пропатчь прошивку, профит! Хотя не исключено, что при отпадании питания от порта висящие на нем девайсы попытаются тянуть паразитное питание с линий данных и выжгут их нахрен.
0
а где пост-то? я его не нашел
0
Наверно уже в топке.
0
Только зарегистрированные и авторизованные пользователи могут оставлять комментарии.