Управление сервоприводом (сервомашинкой) с помощью микроконтроллера ATMega.
Сервомашинки или сервоприводы нашли широкое применение не только в роботостроении, моделизме, но и в различных отраслях промышленности и приборостроении.
Как устроена сервомашинка

Характеристики сервоприводов
Размер и весРазмеры бывают: "микро", "мини", "стандартный" и "гигант". В пределах каждого класса размеры могут немного меняться. Средние размеры сервоприводов для справки:
- Микро: 24мм x 12мм x 24мм, вес: 5-10 г.
- Мини: 30мм x 15мм x 35мм, вес 25 г.
- Стандарт: 40мм x 20мм x 37мм, вес: 50-60 г.

Скорость
Скорость сервоприводов измеряется временем поворота качалки сервопривода на угол 60 градусов при напряжении питания 4.8В и 6В. Например, сервопривод с параметром 0.22с/60° при 4.8В поворачивает вал на 60 градусов за 0.22с при напряжении питания 4.8В. Это не так быстро, как может показаться. Наиболее быстрые сервоприводы имеют время перемещения от 0.06 до 0.09с.
Угол поворота
Сервоприводы могут иметь угол поворота вала 60, 90, 180 градусов. Угол поворота ограничивается электроникой и механически. Существуют сервоприводы без ограничения, т.е. вращающиеся на 360 градусов. Если у Вас имеется сервопривод с рабочим диапазоном 60 градусов, то расширить его можно только изменив конструкцию сервомашинки. Иногда можно увеличить диапазон специальным образом исказив управляющий сигнал. Но это нестандартный и ненадежный способ.
Момент на валу
Момент сервопривода измеряется по весу груза в кг, который сервопривод может удерживать неподвижно на качалке с плечом 1 см. Указывают две цифры, для напряжения питания 4.8В и 6В. Например, если указано, что сервопривод развивает 10кг/см, значит, что на качалке длиной 1см сервопривод может развить усилие 10 кг, прежде чем остановится. Для качалки в 2см такой сервопривод сможет развить усилие 5кг, а на 5мм 20кг.
Цифровые и аналоговые сервоприводы
Цифровые и аналоговые сервоприводы механически не отличаются друг от друга. У них те же корпуса, моторы, шестеренки и даже потенциометры. Все дело в способе управления мотором. Цифровые сервоприводы более точны и, как правило, имеют меньшее время реакции. Но они потребляют больше энергии, чем аналоговые сервоприводы. Управляющий сигнал для аналоговых и цифровых сервоприводов одинаков.
Управляющий сигнал
Управляющий сигнал представляет собой импульсы переменной ширины. Импульсы повторяются с постоянной частотой (как правило, с частотой 50Гц). Положение сервопривода определяется шириной импульса. Для типичного сервопривода, используемого в радиоуправляемых моделях, длительность импульса в 1500 мкс означает, что сервопривод должен занять среднее положение. Увеличение или уменьшение длины импульса заставит сервопривод повернуться по часовой или против часовой стрелки, соответственно.
Таким образом, для управления сервоприводом нам потребуется формировать ШИМ с частотой 50 герц. При этом для положения "0" длительность импульса должна составлять 1000 микросекунд, а для положения "максимум" - 2000 микросекунды. Среднее положение - 1500 микросекунд.
Схема сервотестера
Финалом наших изысканий будет плата сервотестера, работающая с двумя сервоприводами. Светодиоды отображают режим сервотестера. Формировать ШИМ будем использовать аппаратные возможности микроконтроллера ATMega8, а задающий сигнал будем формировать с учетом положения потенциометра. Управляющие сигналы для сервоприводов формируются на ногах OC1A, OC1B. Режимы переключаются кнопкой. Три светодиода отображают режим работы сервотестера.
- Режим 1 - положение сервомашинок задается потенциометром
- Режим 2 - задается среднее положение сервоприводов
- Режим 3 - задающий сигнал циклически изменяется от одного крайнего положения к другому.
Печатная плата
Файл печатной платы в формате lay можно скачать в конце статьи. Скачать плату, прошивку, исходный код
Исходный код
#include <stdio.h>
#include <avr/io.h>
#include <util/delay.h>
//=================================== АЦП ==================================
//Инициализация АЦП:
void adc_init(void){
ADCSRA = _BV(ADEN) | _BV(ADPS0) | _BV(ADPS1) | _BV(ADPS2); // prescaler = 128
}
//Чтение канала АЦП:
uint32_t adc_read(uint8_t ch){
ADMUX = _BV(REFS0) | (ch & 0x1F); // set channel (VREF = VCC)
ADCSRA &= ~_BV(ADIF); // clear hardware "conversion complete" flag
ADCSRA |= _BV(ADSC); // start conversion
while(ADCSRA & _BV(ADSC)); // wait until conversion complete
return ADC; // read ADC (full 10 bits);
}
int main() {
char mode=0; // Режим - по умолчанию 0
int direct=0;
uint16_t adc_result;
#define ICR_MAX F_CPU/50 // ICR1(TOP) = fclk/(N*f) ; N-Делитель; f-Частота; 1000000/1/50 = 20000
#define OCR_MIN ICR_MAX/20
#define OCR_MAX ICR_MAX/10
#define OCR_CENTER (ICR_MAX/4/10)*3
// На порту кнопки включаем подтягивающий резистор
DDRB &= ~(1<<4);
PORTB |= (1<<4);
// Настраиваем порт светодиодов
DDRC = (1<<1) | (1<<2) | (1<<3);
PORTC |= (1<<(mode+1));
// Настраиваем PWM на таймере 1 (выход на ногах PB1, PB2)
TCCR1A = 0; // Отключаем PWM пока будем конфигурировать
ICR1 = ICR_MAX; // Частота всегда 50 Гц
// Включаем Fast PWM mode via ICR1 на Таймере 1 без делителя частоты
TCCR1A = (1<<WGM11);
TCCR1B = (1<<WGM13) | (1<<WGM12) | (1<<CS10);
// Устанавливае PB1 и PB2 как выход
DDRB |= (1<<1) | (1<<2);
// Включаем PWM на port B1 и B2
TCCR1A |= (1<<COM1A1) | (1<<COM1B1);
// Включаем АЦП
adc_init();
while(1){
// Если кнопка нажата (Переключение режимов)
if ((PINB & (1<<4)) == 0)
{
// Ждем пока кнопку отпустят
while ((PINB & (1<<4)) == 0) {
_delay_ms(200);
}
mode++;
if (mode > 2) {
mode = 0;
}
// Включаем нужный светодиод
PORTC &= ~((1<<1) | (1<<2) | (1<<3));
PORTC |= (1<<(mode+1));
}
switch (mode){
case 0:{
// Задаем положени сервомеханизма, в зависимости от положения потенциометра adc_result
adc_result=adc_read(0);
OCR1A = OCR_MIN+(adc_result * (OCR_MAX-OCR_MIN)/1024);
OCR1B = OCR1A;
break;
}
case 1:{
// Задаем центральное положение сервомеханизма
direct=0;
OCR1A = OCR_CENTER;
OCR1B = OCR1A;
break;
}
case 2:{
// Циклическое изменение положения сервомашинки
if (direct==0){
OCR1A++;
OCR1B++;
if (OCR1A >= OCR_MAX) {
direct=1;
}
}
if (direct==1){
OCR1A--;
OCR1B--;
if (OCR1A <= OCR_MIN) {
direct=0;
}
}
_delay_ms(1);
break;
}
}
}
}
Скачать плату, прошивку, исходный код
Успехов!
Читайте также: Raspberry Pi — ШИМ и Сервопривод
И ни слова о фьюзах...
Фьюзы менять не надо, все в стандартном, заводском состоянии.
Доброго времени суток, повторил данное устройство, заработало сразу без проблем но вот только сервы не доходят до конечных точек. можно ли поправить прошивку например от 0,8 до 2,3мс и частотой 50Гц?
Хотелось бы схему самого сервопривода. Как он устроен. Из DC мотора и эл. схемы. Где взяц схему?
Недавні записи
- Модуль драйверів напівмосту IGBT транзисторів
- Драйвер IGBT транзисторів на A316J
- AS5600. Варіант встановлення на BLDC мотор
- DC-DC для IGBT драйверів ізольований 2 W +15 -8 вольт
- U-FOC - Векторне керування безколекторними моторами
- FOC - своя реалізація векторного керування. Підбиваю підсумки 2022 року
- Конструктор регуляторів моторів. Підбиваю підсумки 2022 року.
- Чому трифазні мотори стали такими популярними?
- FOC & Polar coordinates
- Конструктор регуляторів PMSM, BLDC двигунів
Tags
ngnix avr brushless motor examples dma books lcd usb dht11 piezo led servo web pmsm esp8266 ssd1331 wifi bme280 mpu-9250 capture hih-4000 bldc programmator rs-232 ethernet docker dc-dc sms bkp stm32 css git uart meteo bmp280 3d-printer displays mpx4115a eeprom max1674 soldering atmega timer gps tim flash nvic html java-script pwm solar rfid nodemcu st-link options watchdog adc gpio battery bluetooth raspberry-pi python websocket usart foc mongodb flask mpu-6050 barometer exti smd ssd1306 i2c sensors remap rtc encoder eb-500
Архіви