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

Разработка нового контроллера

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

null

Pavel155 писал(а):

Я готов принять участие. Cам планировал изучить программирование МК и заменить прошивку Таноса под себя.

Отличный повод разобраться в МК.

andrik писал(а):

В своем первом сообщении я писал что собираюсь делать свой контроллер, а это миниустройство сделал просто, что-бы помочь Pavel155.
Если будет начата разработка нового контроллера, с удовольствием приму участие. Пока у меня нет своих двигателей, буду тренироваться и набираться опыта на чужих
P.S. Если что, я пишу на си в кодвижене.


Без проблем. У меня есть свободный Нмост и усеченная плата Таноса для опытов. У Pavel155 их как минимум две . Можно начинать строить на ее базе, а потом, когда поймем что нужно добавить - сделаем нормальную. Также необходимо определиться с возможностями контроллера котрый мы будем разрабатывать.

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

andrik

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

karen

Ребят мне сейчас разрабатывают для 6dof контроллер на авр или на арм, задавайте вопросы

Death_Morozz

andrik писал(а):

нужно отказаться от переменных сопротивлений в обратной связи и поставить энкодеры.

А чем плох вариант, как у null - на датчиках холла? Там же вообще нет никакого механического воздействия.

andrik

Death_Morozz писал(а):

А чем плох вариант, как у null - на датчиках холла?

Для концевых датчиков они конечно подойдут, но отслеживать положение датчиками холла? Этож сколько их надо?

null

karen писал(а):

Ребят мне сейчас разрабатывают для 6dof контроллер на авр или на арм, задавайте вопросы

Интересует алгоритм плавного разгона/торможения приводов. Как реализуется, регулируется ли он?

andrik писал(а):

Для концевых датчиков они конечно подойдут, но отслеживать положение датчиками холла? Этож сколько их надо?

По одному на ось. Honeywell SS495 например.
У меня это реализовано. У CraCk тоже ДХ. Так что аналоговый ввод не стоит отбрасывать.

null

andrik писал(а):

Заодно придумать алгоритм работы с концевиками, от этого будет зависеть работа всего устройства.

Ничего нового не скажу, но надо определиться с "понятиями" так сказать .
Калибровку придется реализовывать в любом случае. Т.е. предположим, если выбран режим работы контроллера с энкодером, привод на невысокой скорости движется в одну сторону пока не достигнет концевика. После срабатывания концевика это координата считается за "0" и привод начинает двигаться в противоположную сторону до другого концевика. Считаем сколько отсчетов энкодера прошло и принимаем за полный диапазон. После этого делим полученное количество отсчетов например пополам (или в зависимости от заранее заданных настроек) и двигаем туда привод. Затем переходим в режим получения данных с ком порта. В общих чертах как-то так для начала. Какие будут соображения?

andrik

null писал(а):

Какие будут соображения?

Полностью согласен, только в случае с энкодерами такую калибровку достаточно будет сделать всего один раз, после сборки сима. В дальнейшем просто дописать в программу контроллера автокалибровку при достижении любого из концевиков. Я для начала наверно сделаю маленький макет 4DOF сима, так гораздо проще будет понять принцип и написать оптимальную прошивку для контроллера.

Pavel155

еще надо предусмотреть ситуацию, когда неожиданно отключатся питание (отрубили 220В, сработал автомат защиты и т.п.). В этот момент моторы остановятся произвольно. И после возобновления питания буду вращаться в произвольную сторону.
Т.е. калибровка должна быть как:
концевик 1 - концевик 2,
так и:
концевик 2 - концевик 1.

andrik

Pavel155 писал(а):

И после возобновления питания буду вращаться в произвольную сторону.

Почему в произвольную? Плавно опустятся вниз и привяжутся по концевику. А расстояние между нижним и верхним концевиком можно хранить в энерго независимой памяти контроллера.

null

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

andrik

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

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

karen писал(а):

Ребят мне сейчас разрабатывают для 6dof контроллер на авр или на арм, задавайте вопросы

Вопросы появяться когда дело дойдет до практики, пока только теория. Интересно на каких двигателях будете собирать и с каким управлением. Я с другом хочу 22 в Киев на выставку поехать, движки посмотреть и с спецами пообщаться.

null

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

Давно читал статью по управлению, очень рекомендую изучить. Проблемы изложенные в ней вовсе не виртуальные и их тоже придется решать.
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

andrik

Все зависит от исполнения. Я планирую использовать сервопривод, в нем уже есть ПИД регулятор.

null

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

AlexVr

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

andrik

Pavel155 писал(а):

Подскажите литературу где почитать по посылке данных в МК.


При создании проекта настроить аппаратный модуль usart, после этого просто читать данные из буфера и использовать по своему усмотрению. Посмотреть пример можно здесь http://proavr.narod.ru/z5.htm

null

Pavel155 писал(а):

Подскажите литературу где почитать по посылке данных в МК.


Про USART валом всего написано - гугл в помощь. Вот тебе кусок кода. В нем инициализация и простой обработчик прерывания, который по приходу байта записывает его в переменную curr_byte. Выдрал из своей программы, но вроде ничего не забыл.

volatile unsigned char curr_byte;    //Прерывание USART, байт пришел.  ISR(USARTRXC_vect)  {  curr_byte = UDR;  return;  }    //Основная программа  
int main(void)  {  //Иницилизация USART. Передача отключена.  #define XTAL 14745600L  #define baudrate 115200L  #define bauddivider (XTAL/(16*baudrate)-1)  #define HI(x) ((x)>>8)  #define LO(x) ((x)& 0xFF)    
UBRRL = LO(bauddivider);  UBRRH = HI(bauddivider);  UCSRA = 0;  UCSRB = 1<<RXEN|0<<TXEN|1<<RXCIE|0<<TXCIE;  UCSRC = 1<<URSEL|1<<UCSZ0|1<<UCSZ1;  }


(Добавление)
Вот пример получше нарыл. В зависимости от величины полученного однобайтного числа (00h-FFh) зажигает от одного до восьми светодиодов. Можно например профайлер сконфигурить на отправку оборотов в ком порт и будет шкала типа как в формуле 1. Я когда-то видос выкладывал. Только надо отправлять не абсолютную, а относительную величину. Реально можно скомпилировать и пробовать. Писал на авр студии.

Удачных экспериментов!

#include <avr/io.h>
#include <avr/interrupt.h>
#define RPMPort   PORTA
volatile unsigned char curr_byte;    
//Прерывание USART, байт пришел.
ISR(USARTRXC_vect)  {  curr_byte = UDR;  return;  }
void ShowRPMBar(unsigned char tr)  {  tr /= 0x1C;  char o;  o = 0xFF;  RPMPort = ~(o << tr);  }
int main(void)
{
#define XTAL 14745600L
#define baudrate 115200L
#define bauddivider (XTAL/(16*baudrate)-1)  #define HI(x) ((x)>>8)  #define LO(x) ((x)& 0xFF)    
UBRRL = LO(bauddivider);  UBRRH = HI(bauddivider);
UCSRA = 0;
UCSRB = 1<<RXEN|0<<TXEN|1<<RXCIE|0<<TXCIE;  UCSRC = 1<<URSEL|1<<UCSZ0|1<<UCSZ1; 
DDRA = 0xFF;
PORTA = 0;
sei();    
while(1) {  ShowRPMBar(curr_byte);  }
}

AlexVr

Вот еще ссылочка http://chipenable.ru/index.php/p...-usart-uart.html

(Добавление)
У меня есть вариант временного решения. Основная задача я так понял - избавиться от "раскачек", которые возникают за счет некорректной работы обратной связи или за счет люфтов. В случае если используются асинхроники с редукторами, в идеале использовать считыватель с вала самого двигателя. Я уже использую энкодер и платку ардуино уно для снятия показаний с вала редуктора. Как уже писал есть минусы - при включении/выключении платформа должна быть в исходном состоянии, есть вероятность накапливания ошибок (если плата "пропускает" несколько сигналов с энкодера, а их всего 15 на 180гр.)

Хочу доработать программу и закрепить энкодер на вал асинхроника.
По моим расчетам 1500 об/мин=25 об/сек=25Гц, контроллер работает на 200 Гц низкая частота позволяет отфильтровывать дребезг и изменение положения вала энкодера не должно пройти незаметно.

Диапазон первичного вала редуктора 20х360=7200 гр, вторичного 180гр.
Что с энкодером - на 360 гр он выдает 15 импульсов (30 щелчков), т.е. на один импульс - 24гр. За 20 оборотов 300 импульсов
Диапазон контроллера 256 импульсов (от 0 до 255).
За шаг берем 1.
Диапазон первичного вала 24х256=6144 гр, вторичного 153,6гр. с точностью позиционирования 0,6 гр - вроде неплохо...

Наверняка бывают энкодеры на 24 щелчка, с таким диапазон можно приблизить к 180гр.

int brightness = 128; // начинаем с половины диапазона
int fadeAmount = 1; // шаг изменения
unsigned long currentTime;
unsigned long loopTime;
const int pin_A = 12; // pin 12
const int pin_B = 11; // pin 11
unsigned char encoder_A;
unsigned char encoder_B;
unsigned char encoder_A_prev=0;

void setup() {
// declare pin 9 to be an output:
pinMode(9, OUTPUT); // устанавливаем pin 9 как выход
pinMode(pin_A, INPUT);
pinMode(pin_B, INPUT);
currentTime = millis();
loopTime = currentTime;
}

void loop() {
currentTime = millis();
if(currentTime >= (loopTime + 5)){ // проверяем каждые 5мс (200 Гц)
encoder_A = digitalRead(pin_A); // считываем состояние выхода А энкодера
encoder_B = digitalRead(pin_B); // считываем состояние выхода А энкодера
if((!encoder_A) && (encoder_A_prev)){ // если состояние изменилось с положительного к нулю
if(encoder_B) {
// выход В в полож. сост., значит вращение по часовой стрелке
// увеличиваем напряжение на 9 ноге, не более чем до 255 импульсов
if(brightness + fadeAmount <= 255) brightness += fadeAmount;
}
else {
// выход В в 0 сост., значит вращение против часовой стрелки
// уменьшаем напряжение на 9 ноге, но не ниже 0
if(brightness - fadeAmount >= 0) brightness -= fadeAmount;
}

}
encoder_A_prev = encoder_A; // сохраняем значение А для следующего цикла

analogWrite(9, brightness); // устанавливаем напряжение на 9 ножку

loopTime = currentTime;
}
}

Осталось добиться, чтобы контроллер "помнил" состояние после снятия питания.
Мне подсказали библиотеку EEPROM:

#include <EEPROM.h>
int addr = 0; //адрес в EEPROM

void setup()
{
byte val = EEPROM.read(addr); // считываем значение из EEPROM
EEPROM.write(addr, val+1);// записываем значение в EEPROM
}

void loop()
{

}

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

null

AlexVr
Тока мне кажется это скетч для ардуино. Соответственно к ней оно и прикручивается. По поводу работы с энкодерами есть несколько отличных статей c реальными примерами на easyelectronics.ru.

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

AlexVr

null писал(а):

Тока мне кажется это скетч для ардуино.


Так у меня и есть ардуино.

null писал(а):

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


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

null

AlexVr писал(а):

В моей конструкции травм при глюках не будет


Вот поэтому я в эту ветку и не писал, хотя я ее начал. У одного три мотора, у другого четыре энкодера, третий пишет еще че-та .... кароч каждый на себя тянет. Таким образом нормальные вещи не делаются. А по мне либо сделать хорошую вещь, либо за нее не браться вообще и пользоваться поделкой от Таноса. Что в общем я пока и делаю. У меня все работает и так.

AlexVr писал(а):

Концевики тоже вещь, не добавляющая надежности.

Инженеры которые проектируют станки с ЧПУ об этом не знают

AlexVr

null писал(а):

У меня все работает и так.


Можно только позавидовать.

Разве плохо, когда вариантов решения одной проблемы несколько?
Я сюда пишу в надежде, что это кому-то будет полезно, ну или по крайней мере моих ошибок не повторят. Сколько людьми грабель-то собрано на поделке Таноса, подвиг которого тем не менее никто еще не повторил.

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

По концевикам - сам эксплуатирую 26 аттракционов в Сити-парке Град. Везде стоят сдвоенные безконтактные датчики, но бывают случаи... спасает механический буфер и отключение по току...

null

AlexVr писал(а):

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


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

Pavel155

а по итогу Павел решил что кодвижн круче

(((
На самом деле я так пытаюсь познать алгоритм контроллеров. Использование программы для меня не принципиально. А так как ветка встала на уровне разговоров, мне показалось, что всех устроил Танос. И я начал делать свою программу вместо Profiler.
Теперь время дошло для МК.

p.s. Если интересно, могу написать простую тестовую прогу, которая будет выдавать данные вместо сендера+профилера. (двигаешь ползунок, получаешь данные от 0 до 1024).

Death_Morozz

AlexVr писал(а):

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

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


Ни в коем случае не прекращай писать о процессе поиска альтернативной реализации сима. Твой сим - очень интересен, я- так слежу за изменениями, всё время что то новое. Это значит, что сим чем то не устраивает, или работает не как хотелось бы. Я верю, что в результате - будет результат!

дальше IMHO : ветка флеймовая получилась изначально, потому как симы разные у всех, и очень трудно найти вариант, устраивающий всех симеров.

Из полезного в этой ветке, пока понятно, что энкодер, самое лучшее решение (ты показал, что это работает).
С этим фактом не поспоришь - аналоговые решения (потенциометры, датчики холла) тут проигрывают по любому.
За калибровку при старте сима - я тоже согласен. проще калибровать запуск, когда будут всегда достоверные значения с простыми алгоритмами (посчитать текущие значения/2).

Техническое задание программисту пока выглядит- смутно, но, может быть, попробовать последовательно разработать его? Например, минимальный код:
1. Получить 1 параметр с тестовой проги/сендера (есть подспорье: тестовую прогу Pavel155, я уверен, - напишет).
2. Мигнуть светодиодом направления на контроллере.

Дальше будет проще, уже будет готовая "болванка" программы..

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

AlexVr

ОК! Разобрались

Pavel155

что-то не могу сделать UART на atmegu 8535

#include <avr/io.h>
#include <avr/iom8535.h>
#include <hd44780.h>

//#define F_CPU 1843200 // Частоста кварца
#define BAUD 115200 // Скорость порта
#define MYUBRR (((184320/(16*BAUD)))-1)

volatile unsigned char ReceivedByte;

int main(void)
{

/* Set baud rate */
UBRRH = (MYUBRR >> 8);
UBRRL = MYUBRR;
/* Enable receiver and transmitter */
UCSRB = (1<<RXEN)|(1<<TXEN);
/* Set frame format: 8data, 1stop bit */
UCSRC =(0<<USBS)|(3<<UCSZ0);

lcd_init();
lcd_clrscr();
lcd_puts("TEST UART");
lcd_goto(0x40);

while ( !( UCSRA & (1<<UDRE)) )
{
ReceivedByte = 'A';
lcd_puts(ReceivedByte);
}

;
UDR = ReceivedByte;

}

null

Pavel155
Правильность инициализации усарт и остального не проверял. Сразу бросается в глаза то, что при выходе из цикла while ты присваеваешь UDR значение переменной, а не наоборот. После чего выполнение программы завершается что тоже неверно, т.е. должен быть какой-то общий цикл. Кроме того по логике, после присвоения должна быть операция вывода на ЖК, а ее там нет. Т.е. ничего не происходит.

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

Pavel155

UCSRC = 1<<URSEL|1<<UCSZ0|1<<UCSZ1;

Почему тут используется 2 bit на стоп ?

ShowRPMBar(curr_byte);
я так понимаю эта функция выводит текущий байт оборотов на порт А ?

Ale

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


Это понятно. Но как быть с "частотниками"? у них управление однополярное, как я понял

(Добавление)
Хотя вопрос не корректный. Нужно обеспечить все способы управления, а не противопоставлять их

AlexVr

Ale писал(а):

Но как быть с "частотниками"? у них управление однополярное, как я понял


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

Pavel155

согласен.

AlexVr

Сильно не пинайте - http://x-simulator.de/forum/...oject-t3713.html

Товарищ строит sim на базе готовых плат Ардуино и Н-мостов. Сами платки весьма и весьма бюджетные. И с USB и нулевым положением Н-моста и с защитой. Аналог ардуинки можно купить за 20 баксов. Организовать выход на частотник - без проблем. Паять самому даже тот же контроллер Таноса - примерно столько же выйдет. Схема там такая:

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

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

Pavel155

Вот программа, можете потестить
http://gamefront.com/files/2...519027/Setup.rar

AlexVr

Запустил - подвигал ничего не изменяется. При нажатии на СТОП - в окошке ошибок порта
-1073807202

Pavel155

а порты в программе определились ?
порты в системе не заняты другими програмами ?

Сендер и профилер запускать не нужно.

(Добавление)
Попробуй установить эту библиотеку
http://joule.ni.com/nidu/cds/vie.../id/2662/lang/en

AlexVr

Библиотеку установил, перезагрузился и заработало!
Pavel155, отличное начало!

AlexVr

Появился вот такой вариант калибровки и работы контроллера с энкодерами ОС:

unsigned int optoPin = A0;  unsigned int opto = 0;  unsigned int start = 0; //флаг, устанавливаемый после центровки двигателя  int count_L = 0;  const int pin_A = 12; // pin 12  unsigned char encoder_L_A;  unsigned char encoder_L_A_prev=0;    void setup() {  pinMode(9, OUTPUT); //устанавливаем pin 9 как выход  pinMode(12, INPUT); //Устанавливаем pin 12 как вход  }    void loop() {    // начало выполнения центровки двигателя.    If (!start) { //если первоначальная центровка еще не выполнена, т.е. start=0    analogWrite(9, LOW); //Включаем на ноге 0В, следовательно двигатель вращается назад.    while(opto<500){ //пока нет сигнала с оптопары. значение АЦП (от 0 до 1024). Какое значение приходит с оптопары?  opto = analogRead(optoPin); //опрашиваем порт A0  delay(100); //задержка, для опроса каждые 0,1 сек., чтобы проц не напрягался  }    analogWrite(9, 128); //Останавливаем двигатель. Значения от 0, он же LOW (выкл) до 255, он же HIGH (вкл).  delay(2000); //Остановка двигателя на 2 сек. Дадим возможность ему остановиться?  opto = 0;    analogWrite(9, HIGH); //Включаем на ноге 5В, следовательно двигатель вращается вперед.    while(opto<500){ //пока нет сигнала со второй оптопары  opto = analogRead(optoPin); //опрашиваем порт A0    encoder_L_A = digitalRead(pin_A); // считываем состояние выхода А энкодера    if((!encoder_L_A) && (encoder_L_A_prev)){ // если состояние изменилось с положительного к нулю  count_L++; //считаем количество импульсов энкодера при вращении от 0 до 180 град.  }  encoder_L_A_prev = encoder_L_A; // сохраняем значение А для следующего цикла  delay(5); //задержка, для опроса каждые 5 мс  }    analogWrite(9, 128); //Останавливаем двигатель.  delay(2000); //Остановка двигателя на 2 сек    count_L /= 2; //делим пополам общее количество импульсов    analogWrite(9, LOW); //Запускаем двигатель назад, для установки на середину    encoder_L_A_prev = 0;    while(count_L>0){ //пока счетчик не уменьшится до 0, т.е. двигатель не примет центральное положение    encoder_L_A = digitalRead(pin_A); // считываем состояние выхода А энкодера    if((!encoder_L_A) && (encoder_L_A_prev)){ // если состояние изменилось с положительного к нулю  count_L--; //уменьшаем количество импульсов на 1  }  encoder_L_A_prev = encoder_L_A; // сохраняем значение А для следующего цикла  delay(5); //задержка, для опроса каждые 5 мс  }    analogWrite(9, 128); //Останавливаем двигатель.    start = 1; //устанавливаем флаг, что центровка выполнена.  }    //Начало основной программы    }

Pavel155

Подскажите, почему Танос в прошивке для аналогового управления применил 16-bit ?
Насколько это критично для управления ПЧ по аналогу ?
и еще, как можно из 2-х байтов 8-bit сделать байт на 16-bit ?

AlexVr

Pavel155 писал(а):

Подскажите, почему Танос в прошивке для аналогового управления применил 16-bit ?
Насколько это критично для управления ПЧ по аналогу ?


Один байт (8 бит) может представлять 256 различных значений чего-либо

16-бит могут хранить 65,536 различных значений чего-либо

Дискретности 256 по входу ПЧ Таносу показалось мало. По факту это 5/256=0,02В - шаг регулировки, ну или 0,2 Гц.

Механический энкодер 30 импульсов на оборот за рабочий цикл в наших симах выдает (у меня допустим редуктор 1/40) 30*40/2=600 импульсов, контроллер их считает парами, итого дискретность 300 в первом приближении вот они 8 бит. Смысла в 16 не вижу.

Pavel155

мне подогнали энкодер на 1000имп/оборот.
думаю мой вариант 16bit

AlexVr

Pavel155 писал(а):

мне подогнали энкодер на 1000имп/оборот.
думаю мой вариант 16bit


Тогда ДА

Для размышлений - макс. амплитуда моей платформы 140 мм. Делим на 256, итого дискретность 0,5 мм. Вполне достаточно.
У тебя амплитуда где-то 400 мм.
Энкодер 30 имп. и 8 бит дадут дискретность 1,5 мм
Энкодер 1000 имп. и 16 бит дадут дискретность 0,04 мм и серьезно нагрузят проц...

Pavel155

Энкодер 1000 имп. и 16 бит дадут дискретность 0,04 мм и серьезно нагрузят проц...

значит надо использовать проц с запасом.
что можете посоветовать ?

AlexVr

Pavel155 писал(а):

значит надо использовать проц с запасом.
что можете посоветовать ?


Атмега должен вытянуть, не стоит переживать.

Я смотрю буржуи массово переходят на платформу ардуино - где-то видимо разжились скетчем http://x-simulator.de/forum/...ridge-t3810.html

http://youtube.com/watch?v=y...feature=youtu.be

http://youtube.com/watch?NR=...mp;v=-s3lOkocCNE

Death_Morozz

IMHO: Раз уж появился кодер, давайте не усложнять ТЗ сразу.
Может попробуем сначала воспроизвести поделку Таноса, только с открытым кодом?

Ale

Посмотрел на arduino. Интересно.

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

(Добавление)
Но у меня на изготовление платы уйдет минимум пара недель

null

Если с выбором МК определились, то надо решить, на какую ногу и что мы будем вешать. Где и как будут храниться настройки, которых по всей видимости будет немало.

Ale писал(а):

С этой точки зрения - приобретение arduino - выигрыш по времени, и не маленький.

Тут как сказать. У меня сейчас на изготовление с лужением уходит 1,5-2 часа максимум. Конечно сама разводка платы отнимает время, но мне это как и остальной процесс доставляет удовольствие. Ради чего я этим всем и занимаюсь. Кроме того можно сделать удобную плату для конкретных целей, а не нечто усредненное.

Ale

Хорошо. Давайте определяться.

Схемотехника - а ля Танос но с поддержкой енкодеров вместо (или вместе с) резисторов обратной связи / датчиков Холла.
Поскольку у енкодера надо заводить на проц две ножки, то может возникнуть проблема нехватки ног, если замахиваться на 4 канала. И хотя у 8535 4 канала PWM (два -16-битных и два 8-битных) предлагаю все же ориентироваться на 3-канальную систему на одной плате.
Теперь - по исполнительным механизмам. Полумост Таноса питается цифрой (ШИМ/PWM).
Для использования асинхронных двигателей с частотным преобразователем нужен аналоговый сигнал. Будем получать его из того же ШИМ с помощью интегратора на операционнике?
Теперь, что касается алгоритма управления двигателем. Насколько я понимаю, от компа софт посылает просто новое положение оси? А уже скорость перемещения, плавность разгона и т.д. задается при настройке контроллера под конкретный сим? Тогда, ИМХО, не за чем "раскручивать" всякие PID регуляторы. Фактически на каждую ось надо задавать несколько констант - максимальная скорость (т.е. ограничения по "амплитуде" сигналов управления двигателями), скорость разгона/торможения (т.е. время выхода с нуля до максимальной скорости), при этом момент начала торможения определять по датчику обратной связи). Ну, плюс к этому, естественно, калибровка концевиков (кстати - оптопара или кнопка?) и собственно диапазона хода для энкодера.

Как-то так получается.

Кстати, кто юзает полумост Таноса - для чего там сигналы Motor IN1/ IN2? Просто для включения каждого плеча?

AlexVr

Ale писал(а):

Схемотехника - а ля Танос но с поддержкой енкодеров вместо (или вместе с) резисторов обратной связи / датчиков Холла.


Да, при желании перенести не базу ардуино не составит проблем

Ale писал(а):

Теперь - по исполнительным механизмам. Полумост Таноса питается цифрой (ШИМ/PWM).
Для использования асинхронных двигателей с частотным преобразователем нужен аналоговый сигнал. Будем получать его из того же ШИМ с помощью интегратора на операционнике?


Стоп. Н-мост может служить преобразователем ШИМ 0В...5В в -10В...+10В (-5В...+5В), который замечательно понимают частотники. Никаких интеграторов и операционников не нужно, максимум RC цепочка.

Ale писал(а):

Кстати, кто юзает полумост Таноса - для чего там сигналы Motor IN1/ IN2? Просто для включения каждого плеча?


Сигналы работают попарно с PWM. Логика HC7408N "и" (на выходе 1 только когда на обоих входах 1, в остальных случаях 0). Сделано это для управления реверсом Н-моста.

Pavel155

Для использования асинхронных двигателей с частотным преобразователем нужен аналоговый сигнал. Будем получать его из того же ШИМ с помощью интегратора на операционнике?

А как влияет битность ШИМ на аналоговый выход ?

null

Ale писал(а):

Поскольку у енкодера надо заводить на проц две ножки, то может возникнуть проблема нехватки ног, если замахиваться на 4 канала.

Для того чтобы сделать 4 оси, я бы с удовольствием выкинул ЖК индикатор, в который я не заглядывал очень давно и освободил ноги МК. А для настройки использовал бы ком порт и гипертерминал. Хотя мне сейчас и двух осей хватает. Тут еще момент - хватит ли производительности МК, но я никогда не писал ничего особо сложного и не могу для себя представить нагрузку.

Ale писал(а):

скорость перемещения, плавность разгона и т.д. задается при настройке контроллера под конкретный сим?

Контроллер таноса по сути имеет только одну настройку - пропорциональную составлящую, т.н. KP settings. И устанавливается она как правило один раз. Как работает регулирование только с пропорциональной составляющей вполне доступно и с графиками описано здесь 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

Ale писал(а):

Тогда, ИМХО, не за чем "раскручивать" всякие PID регуляторы. Фактически на каждую ось надо задавать несколько констант - максимальная скорость (т.е. ограничения по "амплитуде" сигналов управления двигателями), скорость разгона/торможения (т.е. время выхода с нуля до максимальной скорости), при этом момент начала торможения определять по датчику обратной связи).

По сути ничего там особо сложного нет. На том же avrfreaks.net я натыкался на довольно неплохие примеры реализации. В связи с этим думаю не стоит пытаться изобрести велосипед, по итогу получится сложнее или хуже.

Pavel155 писал(а):

А как влияет битность ШИМ на аналоговый выход ?

Разрядность ШИМ влияет на дискретность изменения напряжения. 8бит = FF = 255, 16бит = FF FF = 65535 значений.

Ale

Контроллер таноса по сути имеет только одну настройку - пропорциональную составлящую, т.н. KP settings.

А можно подробнее, на что влияет эта настройка и как она определяется, т.е. от чего зависит? У кого есть опыт настройки?

Для того чтобы сделать 4 оси, я бы с удовольствием выкинул ЖК индикатор, в который я не заглядывал очень давно и освободил ноги МК. А для настройки использовал бы ком порт и гипертерминал. Хотя мне сейчас и двух осей хватает. Тут еще момент - хватит ли производительности МК, но я никогда не писал ничего особо сложного и не могу для себя представить нагрузку.

Ну, я большинство своих проектов писал на ассемблере, там владеешь ситуацией с точностью до такта контроллера. Думаю, что проц вполне потянет 4 канала. Фактически, довольно узкое и требовательное к ресурсам место - как раз енкодеры. Дело в том, что резисторы и датчики Холла являются "абсолютными" датчиками, т.е. после оцифровки на АЦП мы получаем "абсолютное" значение входного напряжения, и, как следствие, точно знаем положение оси. И нам в принципе не важно, с каким периодом мы производим оцифровку. А вот енкодер - это "относительный" датчик. И если мы случайно пропустим прерывание от енкодера - мы начнем ошибаться в определении позиции оси, поскольку сами ее высчитываем внутри процессора. Вот для 4-х осей надо обрабатывать 4 прерывания от енкодеров, не пропуская ни одного.

А на счет индикатора полностью согласен. Единственное "но" - настройка должна производиться так сказать "офлайн", т.е при выключенном симуляторном софте.

(Добавление)
IMHO: Раз уж появился кодер, давайте не усложнять ТЗ сразу.
Может попробуем сначала воспроизвести поделку Таноса, только с открытым кодом?


Код будет открытым

null

Ale писал(а):

А можно подробнее, на что влияет эта настройка и как она определяется, т.е. от чего зависит? У кого есть опыт настройки?

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

Ale писал(а):

Думаю, что проц вполне потянет 4 канала. Фактически, довольно узкое и требовательное к ресурсам место - как раз енкодеры.

Вот кстати интересный вариант http://easyelectronics.ru/obrabotka-mnozhestva-inkrementalnyx-enkoderov-odnovremenno.html. Кроме того для ПИД важно чтобы получение состояния было через какой-то определенный промежуток времени. Поэтому в случае его использования, вариант с прерываниями от энкодера отпадает.

Ale писал(а):

А на счет индикатора полностью согласен. Единственное "но" - настройка должна производиться так сказать "офлайн", т.е при выключенном симуляторном софте.

Так и запишем.

Ale

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


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

За ссылки на статьи по ПИД и ЭНКОДЕРАМ спасибо

Теперь несколько вопросов к пользователям контроллера Таноса.

1 - что во время симуляции посылает софт на контроллер кроме "АБ~a0~~a1~..."?
2 - есть ли определенный период для передачи управляющих посылок, или они могут возникать в произвольные моменты времени. и какова минимальная пауза (таймаут) между двумя последовательными посылками?
3 - длина посылок строго постоянна и зависит от настроек количества осей в софте?
4 - с какой частотой (примерно) контроллер Таноса производит считывание показаний датчиков и производит собственно регулирование осей?

null

Ale писал(а):

1 - что во время симуляции посылает софт на контроллер кроме "АБ~a0~~a1~..."?

Ничего.

Ale писал(а):

2 - есть ли определенный период для передачи управляющих посылок, или они могут возникать в произвольные моменты времени. и какова минимальная пауза (таймаут) между двумя последовательными посылками?

Настраивается в софте в миллисекундах.

Ale писал(а):

3 - длина посылок строго постоянна и зависит от настроек количества осей в софте?

Да.

Ale писал(а):

4 - с какой частотой (примерно) контроллер Таноса производит считывание показаний датчиков и производит собственно регулирование осей?

Неизвестно совсем. У него спрашивать безполезно, так как он там только плату разводил.

Ale

Давайте тогда попробуем охватить используемое железо. Какие типы датчиков обратной связи намечается юзать? (Резисторы, Холла, Энкодеры и проч) Именно типы, что бы можно было в доках посмотреть характеристики.

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

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

Pavel155

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

я думаю надо сделать выход на мост. А переделать под частотники и типы энкодеров можно будет самому при наличии исходников.

null

Переменные резисторы любые, я пробовал 100КОМ. Аналоговые датчики холла SS495. По энкодерам сложно сразу сказать, но можно порассуждать. Я с большой вероятностью буду использовать вот эти. Спецификаций пока найти не могу.

http://fotki.yandex.ru/users/nullrnd/view/492103/

http://fotki.yandex.ru/users/nullrnd/view/492104/
Каким образом и с каким передаточным числом я соединю энкодер с двигателем еще не решил, но буду стремиться получить около 300+ импульсов на весь диапазон перемещения (это не станок с ЧПУ). От крайней верхней до крайней нижней точки мотор проходит предположим около 0,5сек (на самом деле я думаю медленнее). Итого получаем 600имп/сек. В этих идельных условиях частота как бы не слишком высокая. Поэтому особых проблем с опросом на мой взгляд быть не должно. Хотя у тебя по всей видимости опыта больше, тебе и виднее .

AlexVr

Ale писал(а):

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


В этой же теме я просчитывал. Вот страничка http://mal4x.ru/forum/topic.php?...topic=23&p=3

Энкодер у меня механический - при попытке вращать его 25 раз в секунду (мой асинхроник) забрасывает контроллер дребезгом контактов так, что тому плохеет.
Адекватно моя схема производит калибровку (доходит до 2-ух концевиков и останавливается посредине, готовая считать импульсы) при вращении до 2-ух оборотов в секунду. Выход - оптический энкодер, можно простейший из мышки. Можно как у null - те же 30 импульсов за оборот.

(Добавление)
Вот ссылочка
http://soldering.pp.ua/samodelny...enkoder/#more-24

- для наших целей большего и не надо, при условии, что энкодер цепляется на вал самих двигателей. Если на вторичный вал - разрешение минимум 360 имп/об.

Ale

Хорошо, тогда последний (на сегодня) вопрос - кто нибудь может выложить осциллограммы импульсов, идущих с выходов PWM контроллера? или хотя бы измерить их период. Хоть пойму, какой частотой Танос ШИМ запитывает.

Ну и поскольку я собираюсь начинать кодить, вопрос о предпочтениях? Нужен ли Си кому нибудь? Или лучше как раз на ассемблере? Текст, конечно, менее читаем и более громоздок. Зато демократичен, поскольку AVR-студия распространяется бесплатно.

С другой стороны, как я уже писал, имею вскрытый CodeVision AVR. И могу проект на нем сделать. Даже допускаю, что это получится быстрей.

AlexVr

Ale писал(а):

Нужен ли Си кому нибудь?


Я был бы счастлив! Переделать под себя программу на Си и на ассемблере как говорится две большие разницы.
Да и под программу есть заготовки на Си. У Павла по рабочему интерфейсу (надеюсь поделится), у меня по калибровке sima и работе с энкодерами.

null

Ale писал(а):

Хоть пойму, какой частотой Танос ШИМ запитывает.

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

И это, даешь студию с тулчейном!!!

AlexVr

Ale писал(а):

Хоть пойму, какой частотой Танос ШИМ запитывает.


ШИМ или как взорвать MOSFET http://arduino.ru/forum/obsh...k-vzorvat-mosfet

FELiS

null писал(а):

она от 14 до 24кгц.

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

null

FELiS
У меня 22кгц - не слышно. Ты где такую картинку взял?

FELiS

вики статья про скважность

Ale

Господа хорошие, спасибо, конечно. Но меня интересовала только частота .
Про форму и скважность я как бы знаю...

Pavel155

Подскажите как сделать лучше.
в программе используются 3 прерывания:
1. Обработка 1 энкодера и вывод числа импульсов для основной программы. Число импульсов от 0 до 5000;
2. Обработка 2 энкодера и вывод числа импульсов для основной программы;
3. Прием данных по UART 16bit, от 0 до 1024.

и основная программа,
где вычисляется ПИД и вывод его ввиде управления для ШИМ от 0 до 1023.

Встала вот такая задача. Как перевести число импульсов в диапазон от 0 до 1024 ?
И где его лучше обработать, в цикле прерывания или основном цикле ?

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

p.s. формула ПИД: PWM=Kp*(Usart - encoder)

Ale

Подскажите как сделать лучше


Я бы завел еще одно прерывание, по таймеру, в котором устанавливал флаг срабатывания таймера. И уже в основном цикле программы проверял этот флаг и регулирование бы делал только по флагу от таймера. Тогда регулирование пойдет через относительно равные промежутки времени, скажем, с частотой 1 КГц.

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

char TimerFlag;
int encod1, tmp_encod1;

interrupt [EXT_INT0] void ext_int0_isr(void)
{
// тут проводим считывание с энкодера и вычисление нового значения в переменную encod1

}

interrupt [TIM0_OVF] void timer0_ovf_isr(void)
{
TimerFlag=1; // устанавливаем флаг и вываливаемся из перывания
}

void main(void)
{

if (TimerFlag>0)
{
TimerFlag=0; // сбрасываем флаг
cli(); // запрещаем прерывания
tmp_encod1 = encod1 // копируем данные энкодера для дальнейшего безопасного использования
sei(); // разрешаем перывания

// и дальше вычисляем все что надо для ПИД (делим, к примеру, на 5 величину tmp_encod1) и проводим регулирование

}

}

(Добавление)
естественно в процедуре main все делается внутри бесконечного цикла

void main(void)
{

while (1)
{
if (TimerFlag>0)
{

....

Pavel155

вот пока что я реализовал CVAVR
функцию вывода на LCD реализовал для наблюдения. После я это удалю.
  /*****************************************************  This program was produced by the  CodeWizardAVR V2.05.0 Professional  Automatic Program Generator  © Copyright 1998-2010 Pavel Haiduc, HP InfoTech s.r.l.  http://hpinfotech.com    Project :  
Version :  
Date    : 10.04.2012  Author  :  
Company :  
Comments:      
Chip type               : ATmega8535  Program type            : Application  AVR Core Clock frequency: 18,432000 MHz  Memory model            : Small  External RAM size       : 0  Data Stack size         : 128  *****************************************************/    #include <mega8535.h>  #include <alcd.h>  #include <delay.h>    // переменные  //LCD  unsigned char buffer [64];  //Энкодер  
unsigned int enc_1 = 0; // число оборотов  на старте   оси 1  unsigned int enc_2 = 0;   // число оборотов  на старте оси 2  unsigned int max = 5120;   // максимальное число импульсов энкодера  //Uart  
union {       unsigned char all[2];             //буфер для приема данных с ПК      unsigned int bite;                          }un1;  //ШИМ  
unsigned int pwm_1 = 0;  unsigned int pwm_2 = 0;  //ПИД  unsigned int error = 0;  //unsigned char enc_err;  unsigned char kp = 3;  unsigned int pwm_er;        // External Interrupt 0 service routine  interrupt [EXT_INT0] void ext_int0_isr(void)  {  if (!PIND.2^!PIND.6)                      //условие для срабатывания подсчета импульсов с энкодера D2,D6             {  enc_1++;                    //увеличиваем              if (!PINA.1|enc_1 > max) {    //колибровка и верхний предел импульсов                  enc_1 = max;               }               }                else  {  enc_1--;          //уменьшаем                if (!PINA.0|enc_1 < 1)     //колибровка и нижний предел импульсов                 {                   enc_1 = 1;                  }                };               }    // External Interrupt 1 service routine  interrupt [EXT_INT1] void ext_int1_isr(void)  {  if (!PIND.3^!PIND.7)                      //условие для срабатывания подсчета импульсов с энкодера порт D3,D7             {  enc_1++;                    //увеличиваем              if (!PINA.1|enc_1 > max)               {    //колибровка и верхний предел импульсов                  enc_1 = max;               }               }                else  {  enc_1--;          //уменьшаем                if (!PINA.0|enc_1 < 1)     //колибровка и нижний предел импульсов                 {                   enc_1 = 1;                  }                };               }                  #ifndef RXB8  #define RXB8 1  #endif    #ifndef TXB8  #define TXB8 0  #endif    #ifndef UPE  #define UPE 2  #endif    #ifndef DOR  #define DOR 3  #endif    #ifndef FE  #define FE 4  #endif    #ifndef UDRE  #define UDRE 5  #endif    #ifndef RXC  #define RXC 7  #endif    #define FRAMING_ERROR (1<<FE)  #define PARITY_ERROR (1<<UPE)  #define DATA_OVERRUN (1<<DOR)  #define DATA_REGISTER_EMPTY (1<<UDRE)  #define RX_COMPLETE (1<<RXC)    // USART Receiver buffer  #define RX_BUFFER_SIZE 100  char rx_buffer[RX_BUFFER_SIZE];    #if RX_BUFFER_SIZE <= 256  unsigned char rx_wr_index,rx_rd_index,rx_counter;  #else  unsigned int rx_wr_index,rx_rd_index,rx_counter;  #endif    // This flag is set on USART Receiver buffer overflow  bit rx_buffer_overflow;    // USART Receiver interrupt service routine  interrupt [USART_RXC] void usart_rx_isr(void)  {  char status,data;  status=UCSRA;  data=UDR;  if ((status & (FRAMING_ERROR | PARITY_ERROR | DATA_OVERRUN))==0)     {     rx_buffer[rx_wr_index++]=data;  #if RX_BUFFER_SIZE == 256     // special case for receiver buffer size=256     if (++rx_counter == 0)        {  #else     if (rx_wr_index == RX_BUFFER_SIZE) rx_wr_index=0;     if (++rx_counter == RX_BUFFER_SIZE)        {        rx_counter=0;  #endif        rx_buffer_overflow=1;        }     }  }    #ifndef _DEBUG_TERMINAL_IO_  // Get a character from the USART Receiver buffer  #define _ALTERNATE_GETCHAR_  #pragma used+  char getchar(void)  {  char data;  while (rx_counter==0);  data=rx_buffer[rx_rd_index++];  #if RX_BUFFER_SIZE != 256  if (rx_rd_index == RX_BUFFER_SIZE) rx_rd_index=0;  #endif  #asm(\"cli\")  --rx_counter;  #asm(\"sei\")  return data;  }  #pragma used-  #endif      #include <stdio.h>      void main(void)  {  //настройка порта А  (4 входа и 4 выхода)  PORTA=0x0F;  DDRA=0xF0;    //настройка порта D  PORTD=0xCC;  DDRD=0x30;      // Timer/Counter 1 initialization  // Clock source: System Clock  // Clock value: 18432,000 kHz  // Mode: Fast PWM top=0x03FF  // OC1A output: Non-Inv.  // OC1B output: Non-Inv.  // Noise Canceler: Off  // Input Capture on Falling Edge  // Timer1 Overflow Interrupt: Off  // Input Capture Interrupt: Off  // Compare A Match Interrupt: Off  // Compare B Match Interrupt: Off  TCCR1A=0xA3;  TCCR1B=0x09;  TCNT1H=0x00;  TCNT1L=0x00;  ICR1H=0x00;  ICR1L=0x00;  OCR1AH=0x00;  OCR1AL=0x00;  OCR1BH=0x00;  OCR1BL=0x00;      // External Interrupt(s) initialization  // INT0: On  // INT0 Mode: Any change  // INT1: On  // INT1 Mode: Any change  // INT2: Off  GICR|=0xC0;  MCUCR=0x05;  MCUCSR=0x00;  GIFR=0xC0;    // USART initialization  UCSRA=0x00;  UCSRB=0x98;  UCSRC=0x86;  UBRRH=0x00;  UBRRL=0x09;      lcd_init(16);      lcd_clear();      lcd_gotoxy(0,0);      lcd_putsf(\"Pavel155 test 1\");      lcd_gotoxy(0,1);      lcd_putsf(\"Start 2dof...\");      delay_ms(10);      lcd_clear();                    #asm(\"sei\")                 while (getchar()== 0x41&getchar()== 0x42)//в этот цикл          {  // мы попадем ТОЛЬКО когда в буфере            // окажется принятый байт 255 - это 0xFF                          getchar();       //ловим байт 0хFF  (255)           //////////////////////////////////////////////////          //управление 1 осью           //////////////////////////////////////////////////                un1.all[1]=getchar();    //ловим  1 байт  оси 1                 un1.all[0]=getchar();   //ловим  2 байт  оси 1                                    //вычисляем ошибку               // enc_err=  enc_1/5;                error = (un1.bite - (enc_1 / 5)) ;                pwm_er = kp*error;                        pwm_1= pwm_er;                                   sprintf(buffer, \"%3d\",error);         //отправляем в буфер данные позиции оси 1                 lcd_gotoxy(10,0);                 lcd_putsf(\"    \");      //очищаем строку                  lcd_gotoxy(10,0);                 lcd_puts(buffer);       //вывод на LCD                                                //ШИМ для 1 оси                 // pwm_1 - это число от 0 до 1023                 // PWM(PD5) = OCR1A / 10.23  (%)                  OCR1AH = (int)(pwm_1>>8);                 OCR1AL = (int)pwm_1;                 //Выводим на дисплей                 sprintf(buffer, \"%3d\",pwm_1);        //отправляем в буфер данные позиции оси 1                 lcd_gotoxy(5,0);                 lcd_putsf(\"    \");                     //очищаем строку                 lcd_gotoxy(5,0);                                    lcd_puts(buffer);                    //вывод на LCD                      //Выводим показание энкодера 1                 sprintf(buffer, \"%3d\",enc_1);        //отправляем в буфер данные позиции оси 1                 lcd_gotoxy(0,0);                 lcd_putsf(\"    \");                   //очищаем строку                 lcd_gotoxy(0,0);                 lcd_puts(buffer);                    //вывод на LCD                          //////////////////////////////////////////////////          //управление 2 осью           //////////////////////////////////////////////////                   un1.all[1]=getchar();    //ловим  1 байт  оси 2                 un1.all[0]=getchar();    //ловим  2 байт  оси 2                    pwm_2=un1.bite;                                      //ШИМ для 2 оси                  OCR1BH = (int)(pwm_2>>8);                 OCR1BL = (int)pwm_2;                 //Выводим на дисплей                 sprintf(buffer, \"%3d\",pwm_2);         //отправляем в буфер данные позиции оси 1                 lcd_gotoxy(5,1);                 lcd_putsf(\"    \");                   //очищаем строку                 lcd_gotoxy(5,1);                 lcd_puts(buffer);                    //вывод на LCD                                            //Выводим показание энкодера 2                sprintf(buffer, \"%3d\",enc_2);         //отправляем в буфер данные позиции оси 1                lcd_gotoxy(0,1);                lcd_putsf(\"    \");                    //очищаем строку                 lcd_gotoxy(0,1);                lcd_puts(buffer);                     //вывод на LCD          }  }  


p.s. Сильно не пинайте, что не придерживаюсь плана ).

Тема закрыта! Продолжение в теме "Разработка нового контроллера - 2".

Гайды по теме

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

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

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

О чём тема «Разработка нового контроллера»?

Pavel155 писал(а): Я готов принять участие. Cам планировал изучить программирование МК и заменить прошивку Таноса под себя. Отличный повод разобраться в МК. andrik писал(а): В своем первом сообщении я писал что собираюсь делать свой контроллер, а это миниустройство сделал просто, что-бы помочь Pavel155. Если будет…

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

В архиве сохранилось 71 сообщение (с 10 ноября 2011 по 11 апреля 2012). Больше всего писали: null, AlexVr, Pavel155. Тема закрыта, новые ответы не принимаются.

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

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

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

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