roboforum.ru

Технический форум по робототехнике.

Нужна помощь по прерываниям USART

Нужна помощь по прерываниям USART

Yucca » 30 апр 2014, 06:45

Смысл такой: в программе вызываются прерывания по приходу байта на USART, дальше в зависимости от значения этого байта выполняются определенные функции, а именно:
    по приходу номера груза (пока для простоты написала просто 1) робот запускает программу передвижения к нему, устанавливается status=1 для запрета нового задания и разрешаются вложенные прерывания чтобы была возможность остановить робота и сбросить status,

    по приходу 2 - остановка робота и сброс status=0 чтобы разрешить новые задания,

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

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

Кусок кода с подпрограммой обработки прерывания:

Код: Выделить всёРазвернуть
//Подпрограмма-обработчик прерывания по приходу байта на модуль  USART 
ISR( USART0_RX_vect )
{
int data;
data = UDR0; //Присваиваем переменной b содержимое регистра UDR, в котором хранится принятый байт

sei(); // Разрешаем вложенные прерывания для возможности отправки сигнала остановки погрузчика..

// Выполняем обработку принятого байта
if (data=='1')||(status==0)
{
status=1; //Запрещаем начинать другие задания
USART_Transmit("Ready to go\r\n"); //Сообщение о готовности к выполнению задания
Forklift_Go(data); //Передвижение к месту расположения конкретного груза
Forklift_Get(data); //Взятие груза
USART_Transmit("Got it!\r\n"); //Сообщение об успешной идентификации груза
Forklift_Go(finalplace); //Передвижение к месту выдачи груза
Forklift_Release(); //Отпускаем груз
USART_Transmit("Done!\r\n"); //Сообщение об успешной доставке груза
}
else if (data=='2')
{
Forklift_Stop();
status=0; //Разрешаем начинать другие задания
USART_Transmit("Stopped\r\n"); //Сообщение об остановке
}
else if (data=='1')||(status==1)
{
USART_Transmit("Forklift is busy. Press 2 to cancel current task!\r\n"); //Сообщение о занятости погрузчика, чтобы остановить задание нажмите 2
}
}

int main(void) //Главная  программа
{
USART_Init ();
Timer_Init();
Ports_Init();
status=0;
USART_Transmit("Ok!\r\n");//Передаем при включении
sei(); //Разрешаем глобально прерывания

while(1) //вечный цикл
{ }
}


Re: Нужна помощь по прерываниям USART

legion » 30 апр 2014, 07:26

Не двигайте робота в прерывании. Сохраните принятые данные, установите необходимые флаги и выходите из прерывания.
Все остальное выполняйте в основном теле программы.

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

Re: Нужна помощь по прерываниям USART

Myp » 30 апр 2014, 09:36

нельзя в прерываниях ничего делать :)
зашли, поставили флаг, вышли, минимум времени в прерывании надо сидеть.

Re: Нужна помощь по прерываниям USART

Yucca » 01 май 2014, 14:00

Спасибо, программу переделала, но вопрос остается в силе, теперь по прерыванию у меня только записывается новая информацию в переменную data и выводятся оповещения, но основная программа движения всё равно будет выполняться до конца, и только со следующей итерации она заметит что data изменилась... Если например вставить в прерывание команду break, она ведь не будет воспринята циклом основной программы, не могу сообразить как это переделать..

Код: Выделить всёРазвернуть
//Подпрограмма-обработчик прерывания по приходу байта на модуль  USART 
ISR( USART0_RX_vect )
{
int data;
data = UDR0; //Присваиваем переменной b содержимое регистра UDR, в котором хранится принятый байт

if (data=='1')||(status==1)
{
USART_Transmit("Forklift is busy. Press 2 to cancel current task!\r\n"); //Сообщение о занятости погрузчика, чтобы остановить задание нажмите 2
data=0;
}
else if (data=='2')
{
Forklift_Stop();
status=0; //Разрешаем начинать другие задания
USART_Transmit("Stopped\r\n"); //Сообщение об остановке
data=0;
}
}

int main(void) //Главная  программа
{
USART_Init ();
Timer_Init();
Ports_Init();

status=0;
USART_Transmit("Ok!\r\n");//Передаем при включении
sei(); //разрешаем глобально прерывания

while(1) //вечный цикл
{
// Выполняем обработку принятого байта
if (data=='1')||(status==0)
{
status=1; //Запрещаем начинать другие задания
int finalplace;
USART_Transmit("Ready to go\r\n"); //Сообщение о готовности к выполнению задания
Forklift_Go(data); //Передвижение к месту расположения конкретного груза
Forklift_Get(data); //Взятие груза
USART_Transmit("Got it!\r\n"); //Сообщение об успешной идентификации груза
Forklift_Go( finalplace ); //Передвижение к месту выдачи груза
Forklift_Release(); //Отпускаем груз
USART_Transmit("Done!\r\n"); //Сообщение об успешной доставке груза
data=0; //Сбрасываем переменную, чтобы погрузчик не поехал по второму разу
}
}

Re: Нужна помощь по прерываниям USART

avr123.nm.ru » 01 май 2014, 16:38

ИМХО великолепный код UART на прерываниях с буферами приема и передачи делает мастер кода CVAVR :ROFL:
www.proavr.narod.ru/z5.htm

Re: Нужна помощь по прерываниям USART

Yucca » 01 май 2014, 19:29

avr123.nm.ru писал(а):ИМХО великолепный код UART на прерываниях с буферами приема и передачи делает мастер кода CVAVR :ROFL:
http://www.proavr.narod.ru/z5.htm


Да мне не это надо, прерывание по USART я уже сделала, проблема в другом - допустим пришел по USART-прерыванию код груза (1), мы его сохранили в переменную data и в главной программе робот начал движение к этому грузу, а теперь если во время выполнения этого движения опять по USART-прерыванию придет код остановки (2), то после того как этот код мы сохраним в обработчике прерывания, главная программа продолжится с того места, где возникло прерывание, т.е. робот всё равно поедет дальше куда ехал, пока не доедет до конца и уж только потом в следующей итерации посмотрит что код, сохраненный в переменной data изменился..

Re: Нужна помощь по прерываниям USART

dccharacter » 01 май 2014, 20:10

Так ты сделай в функции движения периодическую проверку флага останова

Re: Нужна помощь по прерываниям USART

Yucca » 03 май 2014, 05:15

dccharacter писал(а):Так ты сделай в функции движения периодическую проверку флага останова


Можно пример? Я вот с этим и ломаю голову, не после каждого шага движения же вставлять проверку условия, там функция движения итак пока немаленькая, плюс я хочу заменить ее slam-алгоритмом..
У меня такая идея появилась, что если при прерывании по сигналу остановки, написать команду goto и поставить метку в начало цикла? Так будет работать?

Re: Нужна помощь по прерываниям USART

dccharacter » 03 май 2014, 06:56

Ну кинь функцию движения, посмотрим


Rambler\'s Top100 Mail.ru counter