// Программа следования по линии для Проекта мобильного робота "R1-B1"
// Автор Space:
// -мк ATmega16
// -используется кварц на 8мГц
// -компилятор WinAVR V2.0.5
// Программа 2008 для робота R1-B1 - www.robptsspace.ucoz.ru
//------------------------------------------------------------------------
#include <avr/io.h>
#define bit_is_clear(sfr, bit) \
(!(sfr & _BV(bit)))
#define bit_is_set(sfr, bit) (sfr & _BV(bit))
// назначение определений для танкового привода
#define OUT PORTA
#define MOTOR_FR PA0 // вперед-вправо
#define MOTOR_BR PA1 // назад-вправо
#define MOTOR_BL PA2 // назад-влево
#define MOTOR_FL PA3 // вперед-влево
#define IN PIND
#define LIGHT_R PD4 // правый фотодиод
#define LIGHT_Center PD5 // центральный фотодиод
#define LIGHT_L PD6 // левый фотодиод
#define LED PD2 // светодиод
// Возможные режимы движения для танкового привода
enum {STOP, F, FR, FL};
//------------------------------------------------------------------------------
// Задержка t х 10ms
//------------------------------------------------------------------------------
//#define F_CPU 8000000
#define K_DELAY_10ms F_CPU/600
void Delay_10ms(unsigned char t) {
if (t==0) return;
unsigned int i;
while (t--) for(i=0;i<K_DELAY_10ms; i++);
}
//------------------------------------------------------------------------------
// Включение комбинации моторов для движения в заданном направлении
//------------------------------------------------------------------------------
void go(unsigned char direction){
switch (direction) {
case STOP:
cbi(OUT, MOTOR_FR);
cbi(OUT, MOTOR_BR);
cbi(OUT, MOTOR_BL);
cbi(OUT, MOTOR_FL);
break;
case F:
sbi(OUT, MOTOR_FR);
cbi(OUT, MOTOR_BR);
cbi(OUT, MOTOR_BL);
sbi(OUT, MOTOR_FL);
break;
case FR:
cbi(OUT, MOTOR_FR);
cbi(OUT, MOTOR_BR);
cbi(OUT, MOTOR_BL);
sbi(OUT, MOTOR_FL);
break;
case FL:
sbi(OUT, MOTOR_FR);
cbi(OUT, MOTOR_BR);
cbi(OUT, MOTOR_BL);
cbi(OUT, MOTOR_FL);
break;
}
}
//------------------------------------------------------------------------------
// "STOP", ЕСЛИ НЕТ СИГНАЛА
//------------------------------------------------------------------------------
unsigned char walk(void){
// этот цикл организует остановку
while((bit_is_clear(IN, LIGHT_R)) && (bit_is_clear(IN, LIGHT_Center)) && (bit_is_clear(IN, LIGHT_L))){
go(STOP);
cbi(PORTD, LED); // зажигаем светодиод на PD4
Delay_10ms(125); // движемся в этом направлении 2.5 сек
sbi(PORTD, LED); // гасим светодиод на PD4
Delay_10ms(125); // движемся в этом направлении 2.5 сек
}
// этот цикл организует движение на свет, пока
// есть сигнал хотя бы от одного из датчиков освещенности
while((bit_is_set(IN, LIGHT_L)) || (bit_is_clear(IN, LIGHT_Center)) || (bit_is_set(IN, LIGHT_R))){
if((bit_is_set(IN, LIGHT_L)) && (bit_is_set(IN, LIGHT_Center)) && (bit_is_set(IN, LIGHT_R))) go(STOP); // останавливается
else if((bit_is_clear(IN, LIGHT_R)) && (bit_is_clear(IN, LIGHT_Center)) && (bit_is_clear(IN, LIGHT_L))) go(F);
else if((bit_is_set(IN, LIGHT_L)) && (bit_is_clear(IN, LIGHT_Center)) && (bit_is_set(IN, LIGHT_R))) go(F); // вперёд по чёрной линии
else if((bit_is_set(IN, LIGHT_L)) && (bit_is_set(IN, LIGHT_Center)) && (bit_is_clear(IN, LIGHT_R))) go(FR); // направо по чёрной линии
else if((bit_is_clear(IN, LIGHT_L)) && (bit_is_set(IN, LIGHT_Center)) && (bit_is_set(IN, LIGHT_R))) go(FL); // налево по чёрной линии
else if((bit_is_set(IN, LIGHT_L))) go(FR); // направо по чёрной линии
else if((bit_is_set(IN, LIGHT_R))) go(FL); // налево по чёрной линии
}
return(0);
}
//------------------------------------------------------------------------------
// Главная программа
//------------------------------------------------------------------------------
int main(void)
{
DDRA = 0xff; // назначаем все линии порта A на выход
PORTA = 0x00; // и устанавливаем на них низкий уровень
DDRD = 0x04; // назначаем все линии порта D на вход, кроме PD2
PORTD = 0xfb; // подключаем внутренние нагрузочные резисторы, кроме PD2
// Задержка на старте 5 сек
// чтобы успеть отбежать в сторону :)
// для подсчета числа миганий в цикле
unsigned char i;
for (i=0;i<5;i++){ // Подмигиваем пять раз
cbi(PORTD, LED); // Зажигаем LED
Delay_10ms(250); // пауза
sbi(PORTD, LED); // гасим LED
Delay_10ms(250); // пауза
}
// запускаем главный цикл
while(1) walk();
}
интересует так как у ниво с поворотами?
зато если гусеницы натянуть думаю будит он шустрее.
неужели 7805 так сильно греитса
просто моторчики нельзя чтоли? 
Настольгия 