roboforum.ru

/*!
 * @mainpage
 *
 * Опции для компиляции:
 *
 * 1. avr-gcc сс opts:
 * @code
 * -mmcu={?}        # какой МК?
 * -DF_CPU={?}      # какая частота тактирования?
 * -Os              # оптимизация по размеру
 * -x c++           # компиляция в режиме Си++
 * -g               # включить отладочную информацию в выходной elf
 * -ffunction-sections -fdata-sections   # прочие полезные ключи
 * @endcode
 *
 * 2. avr-gcc linker opts:
 * @code
 * -mmcu={?}
 * -Os
 * -g
 * -Wl,--gc-sections
 * -Wl,--relax
 * -Wl,-Map=main.map    # map-файл
 * @endcode
 */

/*!
 */
#include <inttypes.h>
#include <avr/io.h>
#include <avr/interrupt.h>
#include <stdlib.h>
#include <util/delay.h>

// назначение определений для удобства работы с периферией
#define PORTOUT     PORTB
#define DDROUT      DDRB
#define PINOUT      PINB
#define MOTOR_F     PB5
#define MOTOR_B     PB3
#define TURN_L      PB4
#define TURN_R      PB2
#define IRLED       PB1

#define PORTIN      PORTD
#define DDRIN       DDRD
#define PININ       PIND
#define LIGHT_R     PD0
#define LIGHT_L     PD1
#define BUMPER_F    PD3

#define SBI(port,bit)  port |=  (1<<(bit))
#define CBI(port,bit)  port &= ~(1<<(bit))

// #define outb(port,bit)  port = bit
//<- отказаться! <-Почему?
//<- а смысл истользовать устаревший макрос?, тем более что он ни где не используется

//! Возможные режимы движения
typedef enum {STOP=0, F, FR, FL, B, BR, BL} direction_t;
const unsigned int TIME=1;

// #define F_CPU 4000000
//<- задать это ключем при компиляции -DF_CPU=4000000UL , это впринципе можно и так оставить?
//<- нет это должно быть указано в Makefile, иначе _delay_(.*) не будет работать правильно

/*!
 * таблица вероятностей для выбора направления движения
 * исходя из текущего направления движения
 */
unsigned char p[7][7] = {
    {14,    43,   57,   71,     7,      100,    100},
    {7,     43,   71,   100,    100,    100,    100},
    {7,     50,   93,   100,    100,    100,    100},
    {7,     50,   57,   100,    100,    100,    100},
    {29,    29,   29,   29,     57,     79,     100},
    {36,    36,   36,   36,     71,     93,     100},
    {36,    36,   36,   36,     71,     79,     100},
};


//! текущее направление движения
direction_t this_move;
//unsigned char this_move;

/*!
 * Включение комбинации моторов для движения в заданном направлении
 */
void go(direction_t direction){
    switch (direction) {
    case STOP:
        CBI(PORTOUT, MOTOR_F);
        CBI(PORTOUT, MOTOR_B);
        CBI(PORTOUT, TURN_R);
        CBI(PORTOUT, TURN_L);
        break;

    case F:
        SBI(PORTOUT, MOTOR_F);
        CBI(PORTOUT, MOTOR_B);
        CBI(PORTOUT, TURN_R);
        CBI(PORTOUT, TURN_L);
        break;

    case FR:
        SBI(PORTOUT, MOTOR_F);
        CBI(PORTOUT, MOTOR_B);
        SBI(PORTOUT, TURN_R);
        CBI(PORTOUT, TURN_L);
        break;

    case FL:
        SBI(PORTOUT, MOTOR_F);
        CBI(PORTOUT, MOTOR_B);
        CBI(PORTOUT, TURN_R);
        SBI(PORTOUT, TURN_L);
        break;

    case B:
        CBI(PORTOUT, MOTOR_F);
        SBI(PORTOUT, MOTOR_B);
        CBI(PORTOUT, TURN_R);
        CBI(PORTOUT, TURN_L);
        break;

    case BR:
        CBI(PORTOUT, MOTOR_F);
        SBI(PORTOUT, MOTOR_B);
        SBI(PORTOUT, TURN_R);
        CBI(PORTOUT, TURN_L);
        break;

    case BL:
        CBI(PORTOUT, MOTOR_F);
        SBI(PORTOUT, MOTOR_B);
        CBI(PORTOUT, TURN_R);
        SBI(PORTOUT, TURN_L);
        break;
    }
}

/*!
 * Выбор направления движения в следующем шаге по таблице вероятностей
 */
direction_t next_move(void){
    unsigned char pp,
    direction_t i;

    // получаем случайное число 0..99
    pp = rand()/327;
    // ищем соответствие в таблице вероятностей
    for (i=STOP; i < BL+1; i++) {
        if (p[this_move][i] > pp)
            break;
    }
    this_move = i;       // записываем новое полученное направление как текущее
    return(i);
}

/*!
 * "Случайное блуждание"
 */
inline void walk(void){
    // этот цикл организует "свободное блуждание" пока
    // нет сигнала ни от одного из датчиков освещенности
    while ( (bit_is_set(PININ, LIGHT_R)) && (bit_is_set(PININ, LIGHT_L)) ) {
        // получаем следующее направление движения и
        go(next_move());
        _delay_ms(250); 
    }
    
    for (int ii=0; ii < 10; ii++) {
        _delay_loop_1(TIME);
        CBI(PORTOUT, IRLED);    // включаем ИК светодиод
        _delay_loop_1(TIME);
        SBI(PORTOUT, IRLED);    // выкл ИК светодиод
    }
    
   int count=0;
    for (int u=0; u < 14; u++){
        
        // если есть сигнал на Ик приемнике
        if (bit_is_clear(PININ, BUMPER_F)) {
            count++;
            if (count == 14) {
                if (this_move == FR)
                    go(BL);
                if (this_move == FL)
                    go(BR);
                else
                    go(B);
                
                // дай угадаю, не работает?
                _delay_ms(250);
                _delay_ms(250);
                
                this_move = B;
            }
        }
    }
    
    // этот цикл организует движение на свет, пока
    // есть сигнал хотя бы от одного из датчиков освещенности
    while ( (bit_is_clear(PININ, LIGHT_R)) || (bit_is_clear(PININ, LIGHT_L)) ) {
        if ( (bit_is_clear(PININ, LIGHT_R)) && (bit_is_clear(PININ, LIGHT_L)) )
            go(F);
        else { //<- без этих скобок потенциальное место ошибок
            if (bit_is_clear(PININ, LIGHT_R))
                go(FR);
            else
                if (bit_is_clear(PININ, LIGHT_L))
                    go(FL);
        }
    }
}

/*!
 * Главная программа
 */
int main(void)
{
    DDROUT  = 0xff;
    PORTOUT = 0x00;

    DDRIN   = 0x00;
    PORTIN  = 0xff;

    // запускаем главный цикл
    while(true)
        walk();

    return 0;
}

# Hey Emacs, this is a -*- makefile -*-
#----------------------------------------------------------------------------
# WinAVR Makefile Template written by Eric B. Weddington, Jцrg Wunsch, et al.
#
# Released to the Public Domain
#
# Additional material for this makefile was written by:
# Peter Fleury
# Tim Henigan
# Colin O'Flynn
# Reiner Patommel
# Markus Pfaff
# Sander Pool
# Frederik Rouleau
#
#----------------------------------------------------------------------------
# On command line:
#
# make all = Make software.
#
# make clean = Clean out built project files.
#
# make coff = Convert ELF to AVR COFF.
#
# make extcoff = Convert ELF to AVR Extended COFF.
#
# make program = Download the hex file to the device, using avrdude.
#                Please customize the avrdude settings below first!
#
# make debug = Start either simulavr or avarice as specified for debugging, 
#              with avr-gdb or avr-insight as the front end for debugging.
#
# make filename.s = Just compile filename.c into the assembler code only.
#
# make filename.i = Create a preprocessed source file for use in submitting
#                   bug reports to the GCC project.
#
# To rebuild project do "make clean" then "make all".
#----------------------------------------------------------------------------


# MCU name
MCU = atmega8


# Processor frequency.
#     This will define a symbol, F_CPU, in all source code files equal to the 
#     processor frequency. You can then use this symbol in your source code to 
#     calculate timings. Do NOT tack on a 'UL' at the end, this will be done
#     automatically to create a 32-bit value in your source code.
F_CPU = 4000000


# Output format. (can be srec, ihex, binary)
FORMAT = ihex


# Target file name (without extension).
TARGET = z1


# List C source files here. (C dependencies are automatically generated.)
SRC =  z1.c

# List Assembler source files here.
#     Make them always end in a capital .S.  Files ending in a lowercase .s
#     will not be considered source files but generated files (assembler
#     output from the compiler), and will be deleted upon "make clean"!
#     Even though the DOS/Win* filesystem matches both .s and .S the same,
#     it will preserve the spelling of the filenames, and gcc itself does
#     care about how the name is spelled on its command-line.
ASRC = 


# Optimization level, can be [0, 1, 2, 3, s]. 
#     0 = turn off optimization. s = optimize for size.
#     (Note: 3 is not always the best optimization level. See avr-libc FAQ.)
OPT = s


# Debugging format.
#     Native formats for AVR-GCC's -g are dwarf-2 [default] or stabs.
#     AVR Studio 4.10 requires dwarf-2.
#     AVR [Extended] COFF format requires stabs, plus an avr-objcopy run.
DEBUG = stabs


# List any extra directories to look for include files here.
#     Each directory must be seperated by a space.
#     Use forward slashes for directory separators.
#     For a directory that has spaces, enclose it in quotes.
EXTRAINCDIRS = 


# Compiler flag to set the C Standard level.
#     c89   = "ANSI" C
#     gnu89 = c89 plus GCC extensions
#     c99   = ISO C99 standard (not yet fully implemented)
#     gnu99 = c99 plus GCC extensions
CSTANDARD = -std=gnu99


# Place -D or -U options here
CDEFS = -DF_CPU=$(F_CPU)UL


# Place -I options here
CINCS =



#---------------- Compiler Options ----------------
#  -g*:          generate debugging information
#  -O*:          optimization level
#  -f...:        tuning, see GCC manual and avr-libc documentation
#  -Wall...:     warning level
#  -Wa,...:      tell GCC to pass this to the assembler.
#    -adhlns...: create assembler listing
CFLAGS = -g$(DEBUG)
CFLAGS += -x c++
CFLAGS += $(CDEFS) $(CINCS)
CFLAGS += -O$(OPT)
CFLAGS += -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums

CFLAGS += -Wa,-adhlns=$(<:.c=.lst)
CFLAGS += $(patsubst %,-I%,$(EXTRAINCDIRS))
CFLAGS += $(CSTANDARD)


#---------------- Assembler Options ----------------
#  -Wa,...:   tell GCC to pass this to the assembler.
#  -ahlms:    create listing
#  -gstabs:   have the assembler create line number information; note that
#             for use in COFF files, additional information about filenames
#             and function names needs to be present in the assembler source
#             files -- see avr-libc docs [FIXME: not yet described there]
ASFLAGS = -Wa,-adhlns=$(<:.S=.lst),-gstabs 


#---------------- Library Options ----------------
# Minimalistic printf version
PRINTF_LIB_MIN = -Wl,-u,vfprintf -lprintf_min

# Floating point printf version (requires MATH_LIB = -lm below)
PRINTF_LIB_FLOAT = -Wl,-u,vfprintf -lprintf_flt

# If this is left blank, then it will use the Standard printf version.
PRINTF_LIB = 
#PRINTF_LIB = $(PRINTF_LIB_MIN)
#PRINTF_LIB = $(PRINTF_LIB_FLOAT)


# Minimalistic scanf version
SCANF_LIB_MIN = -Wl,-u,vfscanf -lscanf_min

# Floating point + %[ scanf version (requires MATH_LIB = -lm below)
SCANF_LIB_FLOAT = -Wl,-u,vfscanf -lscanf_flt

# If this is left blank, then it will use the Standard scanf version.
SCANF_LIB = 
#SCANF_LIB = $(SCANF_LIB_MIN)
#SCANF_LIB = $(SCANF_LIB_FLOAT)


MATH_LIB = -lm



#---------------- External Memory Options ----------------

# 64 KB of external RAM, starting after internal RAM (ATmega128!),
# used for variables (.data/.bss) and heap (malloc()).
#EXTMEMOPTS = -Wl,-Tdata=0x801100,--defsym=__heap_end=0x80ffff

# 64 KB of external RAM, starting after internal RAM (ATmega128!),
# only used for heap (malloc()).
#EXTMEMOPTS = -Wl,--defsym=__heap_start=0x801100,--defsym=__heap_end=0x80ffff

EXTMEMOPTS =



#---------------- Linker Options ----------------
#  -Wl,...:     tell GCC to pass this to linker.
#    -Map:      create map file
#    --cref:    add cross reference to  map file
LDFLAGS = -Wl,-Map=$(TARGET).map,--cref
LDFLAGS += $(EXTMEMOPTS)
LDFLAGS += $(PRINTF_LIB) $(SCANF_LIB) $(MATH_LIB)



#---------------- Programming Options (avrdude) ----------------

# Programming hardware: alf avr910 avrisp bascom bsd 
# dt006 pavr picoweb pony-stk200 sp12 stk200 stk500
#
# Type: avrdude -c ?
# to get a full listing.
#
AVRDUDE_PROGRAMMER = pony-stk200

# com1 = serial port. Use lpt1 to connect to parallel port.
AVRDUDE_PORT = lpt1

AVRDUDE_WRITE_FLASH = -U flash:w:$(TARGET).hex
#AVRDUDE_WRITE_EEPROM = -U eeprom:w:$(TARGET).eep


# Uncomment the following if you want avrdude's erase cycle counter.
# Note that this counter needs to be initialized first using -Yn,
# see avrdude manual.
#AVRDUDE_ERASE_COUNTER = -y

# Uncomment the following if you do /not/ wish a verification to be
# performed after programming the device.
#AVRDUDE_NO_VERIFY = -V

# Increase verbosity level.  Please use this when submitting bug
# reports about avrdude. See <http://savannah.nongnu.org/projects/avrdude> 
# to submit bug reports.
#AVRDUDE_VERBOSE = -v -v

AVRDUDE_FLAGS = -p $(MCU) -P $(AVRDUDE_PORT) -c $(AVRDUDE_PROGRAMMER)
AVRDUDE_FLAGS += $(AVRDUDE_NO_VERIFY)
AVRDUDE_FLAGS += $(AVRDUDE_VERBOSE)
AVRDUDE_FLAGS += $(AVRDUDE_ERASE_COUNTER)



#---------------- Debugging Options ----------------

# For simulavr only - target MCU