diff --git a/communications/Makefile b/communications/Makefile
index 17a0a643714bc0e6bb803b19868e0fcc25a251ae..31e357108472b6ee57388dcf06edc7cf1ffe2aff 100644
--- a/communications/Makefile
+++ b/communications/Makefile
@@ -15,7 +15,7 @@ CC=avr-gcc
OBJCOPY=avr-ar
MMCU=atmega2561
-CFLAGS=-mmcu=$(MMCU) -Wall -Os -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
ARFLAGS=rsc
diff --git a/communications/include/serial_console.h b/communications/include/serial_console.h
index dae9cb9834d42afc589bdd3e0144440489b6dac3..e21d13fd147c8ee3d2a863894cf37a00d1fd9810 100644
--- a/communications/include/serial_console.h
+++ b/communications/include/serial_console.h
@@ -9,7 +9,9 @@ extern "C" {
#include <avr/interrupt.h>
void serial_console_init(uint32_t baudrate);
-int printf(const char *fmt, ...);
+uint8_t serial_console_get_num_data(void);
+int cm510_printf(const char *fmt, ...);
+int cm510_scanf(const char *fmt, ... );
#ifdef __cplusplus
}
diff --git a/communications/src/examples/Makefile b/communications/src/examples/Makefile
index fd3b35d327a4feadee4160ce1945fbf9222837d0..1c56a7a50e7a050aa5797da2170182f0604cfde0 100644
--- a/communications/src/examples/Makefile
+++ b/communications/src/examples/Makefile
@@ -14,7 +14,7 @@ MMCU=atmega2561
LIBS=$(COMM_DIR)libcomm.a
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/communications/src/examples/main.c b/communications/src/examples/main.c
index 6188a35168e74d4c7ab8c2dc24e99b65db3eeac3..a3d6baa646d72b0c620743726f7ee7d0a3f96702 100755
--- a/communications/src/examples/main.c
+++ b/communications/src/examples/main.c
@@ -19,12 +19,12 @@ int16_t main(void)
dyn_master_scan(&num,ids);
if(num==1)
{
- printf("Found one device\n");
+ cm510_printf("Found one device\n");
PORTC=0x3F;
}
else
{
- printf("No device found\n");
+ cm510_printf("No device found\n");
PORTC=0x7F;
}
}
diff --git a/communications/src/serial_console.c b/communications/src/serial_console.c
index 89bfd5267a1e5026dc20fad1e602129abd2cb8c2..97dd04850a3c42e81b638f7a8440df4887923f10 100644
--- a/communications/src/serial_console.c
+++ b/communications/src/serial_console.c
@@ -140,8 +140,16 @@ void serial_console_init(uint32_t baudrate)
device=fdevopen(serial_console_putchar,serial_console_getchar);
}
-int printf(const char *fmt, ...)
+uint8_t serial_console_get_num_data(void)
+{
+ return serial_console_rx_num_data;
+}
+
+int cm510_printf(const char *fmt, ...)
{
+ #ifdef __REAL__
+ return 0;
+ #else
va_list ap;
int i;
@@ -149,4 +157,17 @@ int printf(const char *fmt, ...)
i = vfprintf(stdout, fmt, ap);
va_end(ap);
return i;
+ #endif
+}
+
+int cm510_scanf(const char *fmt, ...)
+{
+ va_list arg;
+ int done;
+
+ va_start (arg, fmt);
+ done = vfscanf (stdin, fmt, arg);
+ va_end (arg);
+
+ return done;
}
diff --git a/controllers/Makefile b/controllers/Makefile
index 06de89ab4c2f0b0213c68472f70a022962d96a9f..9315f6f6f7ffacf49480ee4af33cf66e2f2c2cca 100755
--- a/controllers/Makefile
+++ b/controllers/Makefile
@@ -18,7 +18,7 @@ INC_DIRS=-I$(CONT_DIR)include/ -I$(COMM_DIR)include -I$(DEV_DIR)include -I$(MAN_
LIBS=$(COMM_DIR)lib/libcomm.a $(DEV_DIR)lib/libdyn_devices.a $(MAN_DIR)lib/libmotion_manager.a
-CFLAGS=-mmcu=$(MMCU) -Wall -O3 -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -O3 -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
ARFLAGS=rsc
diff --git a/controllers/src/examples/Makefile b/controllers/src/examples/Makefile
index 7c7088841ea4c814e6c9be041459741a658ea512..7a53003c279ef951de88b4425b1804bc6c7f08cf 100644
--- a/controllers/src/examples/Makefile
+++ b/controllers/src/examples/Makefile
@@ -18,7 +18,7 @@ INCLUDE_DIRS=-I$(CONT_DIR)include/ -I$(COMM_DIR)include -I$(MAN_DIR)include -I$(
LIBS=$(CONT_DIR)lib/libcontrollers.a $(MAN_DIR)lib/libmotion_manager.a $(COMM_DIR)lib/libcomm.a $(DEV_DIR)lib/libdyn_devices.a
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/controllers/src/examples/main.c b/controllers/src/examples/main.c
index a1d62161825f6ddd3735b991735363977c2d59ac..73a75bd5eebc800697165e7aa663b37501fe044e 100755
--- a/controllers/src/examples/main.c
+++ b/controllers/src/examples/main.c
@@ -29,8 +29,8 @@ void user_loop(void)
{
if(user_time_is_period_done())
{
- printf("Gyro X: %d\n",get_adc_channel(ADC_PORT_3));
- printf("Gyro Y: %d\n",get_adc_channel(ADC_PORT_4));
+ cm510_printf("Gyro X: %d\n",get_adc_channel(ADC_PORT_3));
+ cm510_printf("Gyro Y: %d\n",get_adc_channel(ADC_PORT_4));
}
if(is_button_pressed(BTN_START))
turn_led_on(LED_AUX);
diff --git a/dyn_devices/Makefile b/dyn_devices/Makefile
index c0bcc5b33104e21947c6a0c2281013734ca8498d..0536f19dad92634c408815b9c66b05eaa38844c8 100755
--- a/dyn_devices/Makefile
+++ b/dyn_devices/Makefile
@@ -14,7 +14,7 @@ INC_DIRS=-I./include/ -I$(COMM_DIR)/include -I$(CONT_DIR)/include
LIBS=$(COMM_DIR)/lib/libcomm.a
-CFLAGS=-mmcu=$(MMCU) -Wall -O3 -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -O3 -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
ARFLAGS=rsc
diff --git a/dyn_devices/src/examples/Makefile b/dyn_devices/src/examples/Makefile
index e7b85a0f0848d840f98261c705815b49cb50d5bd..05e3b278186f1d327781061eafe01ba763228476 100755
--- a/dyn_devices/src/examples/Makefile
+++ b/dyn_devices/src/examples/Makefile
@@ -19,7 +19,7 @@ LIBS=$(COMM_DIR)lib/libcomm.a $(DEV_DIR)lib/libdyn_devices.a
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/dyn_devices/src/examples/exp_board_ex.c b/dyn_devices/src/examples/exp_board_ex.c
index bff254aef9ec74d57a7f01c2aecf49b065711ee9..2d757002167cf563361ec6e998a717e96069cf1f 100755
--- a/dyn_devices/src/examples/exp_board_ex.c
+++ b/dyn_devices/src/examples/exp_board_ex.c
@@ -32,41 +32,41 @@ int main(void)
_delay_ms(4000);
if(exp_board_init(0xC0)==0x00)
{
- printf("expansion baord found\n");
+ cm510_printf("expansion baord found\n");
/* GPIO test */
/* if(exp_gpio_config(GPIO0,GPIO_OUT))
- printf("Error configuring the GPIO0 pin\n");
+ cm510_printf("Error configuring the GPIO0 pin\n");
if(exp_gpio_config(GPIO1,GPIO_IN))
- printf("Error configuring the GPIO1 pin\n");
+ cm510_printf("Error configuring the GPIO1 pin\n");
for(i=0;i<10;i++)
{
if(exp_gpio_set_value(0,1))
- printf("Error Error setting the value of the GPIO0 pin\n");
+ cm510_printf("Error Error setting the value of the GPIO0 pin\n");
if(exp_gpio_get_value(GPIO1)==0x01)
- printf("GPIO pin is HIGH\n");
+ cm510_printf("GPIO pin is HIGH\n");
else if(exp_gpio_get_value(GPIO1)==0x00)
- printf("GPIO pin is LOW\n");
+ cm510_printf("GPIO pin is LOW\n");
else
- printf("Error getting the GPIO1 value\n");
+ cm510_printf("Error getting the GPIO1 value\n");
_delay_ms(1000);
if(exp_gpio_set_value(0,0))
- printf("Error Error setting the value of the GPIO1 pin\n");
+ cm510_printf("Error Error setting the value of the GPIO1 pin\n");
if(exp_gpio_get_value(GPIO1)==0x00)
- printf("GPIO pin is LOW\n");
+ cm510_printf("GPIO pin is LOW\n");
else if(exp_gpio_get_value(GPIO1)==0x01)
- printf("GPIO pin is HIGH\n");
+ cm510_printf("GPIO pin is HIGH\n");
else
- printf("Error getting the GPIO1 value\n");
+ cm510_printf("Error getting the GPIO1 value\n");
_delay_ms(1000);
}*/
/* LED and switches test */
/* for(i=0;i<10;i++)
{
exp_gpio_set_led();
- printf("Switches value: %d\n",exp_gpio_get_switches());
+ cm510_printf("Switches value: %d\n",exp_gpio_get_switches());
_delay_ms(1000);
exp_gpio_clear_led();
- printf("Switches value: %d\n",exp_gpio_get_switches());
+ cm510_printf("Switches value: %d\n",exp_gpio_get_switches());
_delay_ms(1000);
}*/
/* PWM test */
@@ -89,58 +89,58 @@ int main(void)
for(i=0;i<10;i++)
{
exp_dac_set_voltage(DAC0,1000);
- printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
+ cm510_printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
_delay_ms(1000);
exp_dac_set_voltage(DAC0,2000);
- printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
+ cm510_printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
_delay_ms(1000);
exp_dac_set_voltage(DAC0,3000);
- printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
+ cm510_printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
_delay_ms(1000);
exp_dac_set_voltage(DAC0,4000);
- printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
+ cm510_printf("Volatge: %d mV\n",exp_dac_get_voltage(DAC0));
_delay_ms(1000);
}
dac_stop();*/
/* compass test */
exp_compass_start();
- printf("Number of samples to average: %d\n",exp_compass_get_avg_samples());
+ cm510_printf("Number of samples to average: %d\n",exp_compass_get_avg_samples());
for(i=0;i<100;i++)
{
- printf("Current heading: %d\n",exp_compass_get_heading());
- printf("Current averaged heading: %d\n",exp_compass_get_avg_heading());
+ cm510_printf("Current heading: %d\n",exp_compass_get_heading());
+ cm510_printf("Current averaged heading: %d\n",exp_compass_get_avg_heading());
_delay_ms(1000);
}
exp_compass_stop();
/* ADC test */
/* exp_adc_start();
- printf("Number of samples to average: %d\n",exp_adc_get_average_samples());
- printf("Sampling period: %d ms\n",exp_adc_get_sample_period());
+ cm510_printf("Number of samples to average: %d\n",exp_adc_get_average_samples());
+ cm510_printf("Sampling period: %d ms\n",exp_adc_get_sample_period());
for(i=0;i<100;i++)
{
- printf("Current voltage at ADC0: %d mV\n",exp_adc_get_channel(ADC0));
- printf("Current averaged voltage at ADC0: %d mV\n",exp_adc_get_avg_channel(ADC0));
+ cm510_printf("Current voltage at ADC0: %d mV\n",exp_adc_get_channel(ADC0));
+ cm510_printf("Current averaged voltage at ADC0: %d mV\n",exp_adc_get_avg_channel(ADC0));
_delay_ms(1000);
}
exp_adc_stop();*/
/* UART USB test */
/* exp_uart_usb_start();
- printf("current baudrate: %d\n",exp_uart_usb_get_baudrate());
+ cm510_printf("current baudrate: %d\n",exp_uart_usb_get_baudrate());
for(i=0;i<10;i++)
{
while(!exp_uart_usb_is_data_available())
_delay_ms(100);
data=exp_uart_usb_receive_data();
- printf("Received data: %d\n",data);
+ cm510_printf("Received data: %d\n",data);
exp_uart_usb_send_byte(data);
while(exp_uart_usb_is_sending())
_delay_ms(100);
- printf("data sent\n");
+ cm510_printf("data sent\n");
}
exp_uart_usb_stop();*/
}
else
- printf("expansion board not found\n");
+ cm510_printf("expansion board not found\n");
while(1);
}
diff --git a/dyn_devices/src/examples/servos_ex.c b/dyn_devices/src/examples/servos_ex.c
index f9ad49f2833c93b6444ef382640f07026af36b93..3dbb1a2adc27597f007951a979b9026114b5296f 100755
--- a/dyn_devices/src/examples/servos_ex.c
+++ b/dyn_devices/src/examples/servos_ex.c
@@ -35,7 +35,7 @@ int main(void)
if(num>0)
{
model=get_model_number(ids[0]);
- printf("%d\n",model);
+ cm510_printf("%d\n",model);
set_target_speed(ids[0],100);
for(;;)
{
@@ -50,7 +50,7 @@ int main(void)
}
}
else
- printf("No device found");
+ cm510_printf("No device found");
while(1);
}
diff --git a/examples/get_up/Makefile b/examples/get_up/Makefile
index 0a5a21b65ccf72645bf2f034f5ef30fdd1be8ecd..3dcbe475cca9d01699e00e22dd92ee27906fcac5 100644
--- a/examples/get_up/Makefile
+++ b/examples/get_up/Makefile
@@ -18,7 +18,7 @@ LIBS=$(MAN_DIR)lib/libmotion_manager.a $(CONT_DIR)lib/libcontrollers.a $(COMM_DI
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include -I$(CONT_DIR)include -I$(MAN_DIR)include
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/examples/movements/Makefile b/examples/movements/Makefile
index 6d668f0a8c55d56e746b3cdaa141a2087125f436..84f98f106644726863bcbd568b0d45bd91e566d5 100644
--- a/examples/movements/Makefile
+++ b/examples/movements/Makefile
@@ -18,7 +18,7 @@ LIBS=$(MAN_DIR)lib/libmotion_manager.a $(CONT_DIR)lib/libcontrollers.a $(COMM_DI
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include -I$(CONT_DIR)include -I$(MAN_DIR)include
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/examples/pan_tilt/Makefile b/examples/pan_tilt/Makefile
index 419086620880f1f6fae04368489a249b5993be73..f3d952011102b9a70676a0a29afff2f7be73f10c 100644
--- a/examples/pan_tilt/Makefile
+++ b/examples/pan_tilt/Makefile
@@ -18,7 +18,7 @@ LIBS=$(MAN_DIR)lib/libmotion_manager.a $(CONT_DIR)lib/libcontrollers.a $(COMM_DI
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include -I$(CONT_DIR)include -I$(MAN_DIR)include -I../movements
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/examples/pan_tilt/pan_tilt.c b/examples/pan_tilt/pan_tilt.c
index 9c0e48663178438a2fe5d86a471626ef0e837aff..8445616d9b66924257b7193322990fce3010ea42 100644
--- a/examples/pan_tilt/pan_tilt.c
+++ b/examples/pan_tilt/pan_tilt.c
@@ -35,7 +35,7 @@ void user_loop(void)
}
else
state=wait_start;
- printf("wait_start %d\n",(int)state);
+ cm510_printf("wait_start %d\n",(int)state);
break;
case wait_cmd: if(is_button_rising_edge(BTN_LEFT))
{
diff --git a/examples/sensors/Makefile b/examples/sensors/Makefile
index 28b3e0c24906717431c70ae444f406116244658b..dc31ef4e263a2e5a7ced250c329d8f49f463acb6 100644
--- a/examples/sensors/Makefile
+++ b/examples/sensors/Makefile
@@ -18,7 +18,7 @@ LIBS=$(CONT_DIR)lib/libcontrollers.a $(MAN_DIR)lib/libmotion_manager.a $(DEV_DIR
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include -I$(CONT_DIR)include -I$(MAN_DIR)include
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/examples/sensors/sensors.c b/examples/sensors/sensors.c
index 09e3d421dccda1589231feaf66187d98effccee8..44011f34c0fe42aa02d6208a3a58e2acf960ed15 100644
--- a/examples/sensors/sensors.c
+++ b/examples/sensors/sensors.c
@@ -21,7 +21,7 @@ void user_loop(void)
{
static main_states state=wait_start;
-/* switch(state)
+ switch(state)
{
case wait_start: if(is_button_rising_edge(BTN_START))
{
@@ -37,9 +37,9 @@ void user_loop(void)
else
state=read_sensors;
break;
- case read_sensors: printf("CM510 ADC port 1: %d\n",get_adc_avg_channel(ADC_PORT_2));
- printf("Exp. Board compass: %d\n",exp_compass_get_avg_heading());
- printf("Exp. Board ADC port 7: %d\n",exp_adc_get_avg_channel(ADC7));
+ case read_sensors: cm510_printf("CM510 ADC port 1: %d\n",get_adc_avg_channel(ADC_PORT_2));
+ cm510_printf("Exp. Board compass: %d\n",exp_compass_get_avg_heading());
+ cm510_printf("Exp. Board ADC port 7: %d\n",exp_adc_get_avg_channel(ADC7));
break;
- }*/
+ }
}
diff --git a/examples/stairs/Makefile b/examples/stairs/Makefile
index 746c9e6374b09e2557d4e4a07341418e7b4620b4..09812e87e450c8a46963b900c89f66dffa151365 100644
--- a/examples/stairs/Makefile
+++ b/examples/stairs/Makefile
@@ -18,7 +18,7 @@ LIBS=$(MAN_DIR)lib/libmotion_manager.a $(CONT_DIR)lib/libcontrollers.a $(COMM_DI
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include -I$(CONT_DIR)include -I$(MAN_DIR)include -I../movements
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/examples/vision/Makefile b/examples/vision/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..2181ffc707c9b67b403be35a16c3073cc88c523b
--- /dev/null
+++ b/examples/vision/Makefile
@@ -0,0 +1,63 @@
+# computer code
+INPUT_FILE = vision.cpp
+OUTPUT_FILE = vision
+LIBS = -lpthread -L/usr/lib -lopencv_calib3d -lopencv_contrib -lopencv_core -lopencv_features2d -lopencv_flann -lopencv_gpu -lopencv_highgui -lopencv_imgproc -lopencv_legacy -lopencv_ml -lopencv_objdetect -lopencv_ocl -lopencv_photo -lopencv_stitching -lopencv_superres -lopencv_ts -lopencv_video -lopencv_videostab -L/usr/local/lib/iridrivers -ldetectqrcode -lcomm -liriutils
+INCLUDES = -I. -I/usr/include/opencv -I/usr/local/include/iridrivers
+
+# microcontroller code
+CM510_PROJECT = cm510_vision
+CM510_SOURCES = cm510_vision.c
+
+CM510_OBJS=$(CM510_SOURCES:.c=.o)
+CM510_SRC_DIR=./
+CM510_DEV_DIR=../../dyn_devices/
+CM510_COMM_DIR=../../communications/
+CM510_CONT_DIR=../../controllers/
+CM510_MAN_DIR=../../motion/
+CC=avr-gcc
+OBJCOPY=avr-objcopy
+MMCU=atmega2561
+
+CM510_LIBS=$(CM510_MAN_DIR)lib/libmotion_manager.a $(CM510_CONT_DIR)lib/libcontrollers.a $(CM510_COMM_DIR)lib/libcomm.a $(CM510_DEV_DIR)lib/libdyn_devices.a
+
+CM510_INCLUDE_DIRS=-I$(CM510_DEV_DIR)include -I$(CM510_COMM_DIR)include -I$(CM510_CONT_DIR)include -I$(CM510_MAN_DIR)include -I../movements
+
+CFLAGS=-mmcu=$(MMCU) -Wall -Os -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+
+LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(CM510_PROJECT).map -DF_CPU=16000000UL
+
+HEX_FLASH_FLAGS = -R .eeprom -R .fuse -R .lock -R .signature
+
+all: communications dyn_devices controllers motion_manager $(CM510_PROJECT).hex
+ $(CXX) $(INPUT_FILE) $(LIBS) $(INCLUDES) -o $(OUTPUT_FILE)
+
+$(CM510_PROJECT).hex: $(CM510_PROJECT).elf
+ $(OBJCOPY) -O ihex $(HEX_FLASH_FLAGS) $< $@
+$(CM510_PROJECT).elf: $(CM510_OBJS)
+ $(CC) $(LDFLAGS) $(CM510_OBJS) $(CM510_LIBS) -o $(CM510_PROJECT).elf
+%.o:%.c
+ $(CC) -c $(CFLAGS) $(CM510_INCLUDE_DIRS) -o $@ $<
+
+communications:
+ $(MAKE) -C $(CM510_COMM_DIR)
+
+dyn_devices:
+ $(MAKE) -C $(CM510_DEV_DIR)
+
+controllers:
+ $(MAKE) -C $(CM510_CONT_DIR)
+
+motion_manager:
+ $(MAKE) -C $(CM510_MAN_DIR)
+
+download: $(MAIN_OUT_HEX)
+ fw_downloader -d /dev/ttyUSB0 -f ./$(CM510_PROJECT).hex -p cm510
+
+clean:
+ -rm $(CM510_PROJECT).map
+ -rm $(CM510_PROJECT).hex
+ -rm $(CM510_PROJECT).elf
+ -rm $(CM510_OBJS)
+ $(RM) $(OUTPUT_FILE)
+
+.PHONY: all clean
diff --git a/examples/vision/cm510_vision.c b/examples/vision/cm510_vision.c
new file mode 100644
index 0000000000000000000000000000000000000000..9c86ccaede8ce9d3f43b552e4cd3a008ee55b3b5
--- /dev/null
+++ b/examples/vision/cm510_vision.c
@@ -0,0 +1,77 @@
+#include <util/delay.h>
+#include "cm510.h"
+#include "balance.h"
+#include "exp_board.h"
+#include "pan_tilt.h"
+#include <stdio.h>
+
+typedef enum {wait_start,wait_cmd,wait_pan_left,wait_pan_right} main_states;
+
+#define PAN_SERVO_ID 19
+#define TILT_SERVO_ID 20
+
+void user_init(void)
+{
+ serial_console_init(57600);
+ balance_init();
+ balance_calibrate_gyro();
+ balance_enable_gyro();
+ user_time_set_period(100);
+ pan_tilt_init(PAN_SERVO_ID,TILT_SERVO_ID);
+}
+
+void user_loop(void)
+{
+ static main_states state=wait_start;
+ uint8_t cmd;
+
+ if(user_time_is_period_done())
+ {
+ switch(state)
+ {
+ case wait_start: if(is_button_rising_edge(BTN_START))
+ {
+ action_set_page(31);
+ action_start_page();
+ state=wait_cmd;
+ }
+ else
+ state=wait_start;
+ break;
+ case wait_cmd: if(serial_console_get_num_data()>0)
+ {
+ printf("New data received\n");
+ cm510_scanf("%c",&cmd);
+ switch(cmd)
+ {
+ case 'l': pan_set_speed(200);
+ pan_move_angle(-70);
+ state=wait_pan_right;
+ printf("move left\n");
+ break;
+ case 'r': pan_set_speed(200);
+ pan_move_angle(70);
+ state=wait_pan_left;
+ printf("move right\n");
+ break;
+ default: state=wait_cmd;
+ break;
+ }
+ }
+ else
+ state=wait_cmd;
+ break;
+ case wait_pan_left: if(pan_is_moving())
+ state=wait_pan_left;
+ else
+ state=wait_cmd;
+ break;
+ case wait_pan_right: if(pan_is_moving())
+ state=wait_pan_right;
+ else
+ state=wait_cmd;
+ break;
+ }
+ }
+}
+
diff --git a/examples/vision/vision.cpp b/examples/vision/vision.cpp
new file mode 100644
index 0000000000000000000000000000000000000000..dbf2bab9bfc44637499ed790b62c4b5a8617a52a
--- /dev/null
+++ b/examples/vision/vision.cpp
@@ -0,0 +1,78 @@
+#include <opencv2/highgui/highgui.hpp>
+#include <opencv2/imgproc/imgproc.hpp>
+#include <iostream>
+#include "detectqrcode.h"
+#include "rs232.h"
+#include "exceptions.h"
+
+using namespace cv;
+using namespace std;
+
+int main()
+{
+ cv::Mat gray;
+ cv::Mat frame;
+ CDetectqrcode detector;
+ std::vector<std::vector<cv::Point> > squares;
+ CRS232 serial_console("bioloid_serial_port");
+ std::string serial_console_device="/dev/pts/27";
+ TRS232_config serial_console_config;
+ std::string cmd;
+
+ cv::VideoCapture cap(0); //0 is the id of video device.0 if you have only one camera.
+
+ if (!cap.isOpened())
+ { //check if video device has been initialised
+ cout << "cannot open camera";
+ return 0;
+ }
+
+ detector.init(721.977446f,717.128980f,334.800583f,242.691968f,0.0475f,0.0475f);
+
+ try{
+ serial_console_config.baud=57600;
+ serial_console_config.num_bits=8;
+ serial_console_config.parity=none;
+ serial_console_config.stop_bits=1;
+ serial_console.open((void *)&serial_console_device);
+ serial_console.config(&serial_console_config);
+ }catch(CException &e){
+ std::cout << e.what() << std::endl;
+ return 0;
+ }
+
+ cv::namedWindow("QRcode",1);
+ //unconditional loop
+
+ for(unsigned int i=0;i<2;i++)
+ {
+ std::cout << "move left" << std::endl;
+ cmd="l\n";
+ serial_console.write((unsigned char *)cmd.c_str(),2);
+ sleep(2);
+ std::cout << "move right" << std::endl;
+ cmd="r\n";
+ serial_console.write((unsigned char *)cmd.c_str(),2);
+ sleep(2);
+ }
+
+ while (true)
+ {
+ cap.read(frame);
+ std::vector<TQRInfo> tags;
+ cv::cvtColor(frame,gray,CV_BGR2GRAY);
+ detector.findSquares(gray, squares);
+ detector.findQR(gray,tags);
+ for(unsigned int i=0;i<tags.size();i++)
+ {
+ std::cout << "Tag ID: " << tags[i].tag_id << std::endl;
+ std::cout << "Tag position: X:" << tags[i].tvec[0] << " Y: " << tags[i].tvec[1] << " Z: " << tags[i].tvec[2] << std::endl;
+ }
+ detector.drawSquares(frame, squares);
+ cv::imshow("QRcode",frame);
+ if (waitKey(30) >= 0)
+ break;
+ }
+
+ return 0;
+}
diff --git a/examples/walk_straight/Makefile b/examples/walk_straight/Makefile
index 428ca8178e98dac817e2a54b24e1f7dca2a31ea1..bf76cb5971018c69cdb33aa6581510f1c6c19447 100644
--- a/examples/walk_straight/Makefile
+++ b/examples/walk_straight/Makefile
@@ -18,7 +18,7 @@ LIBS=$(MAN_DIR)lib/libmotion_manager.a $(CONT_DIR)lib/libcontrollers.a $(COMM_DI
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include -I$(CONT_DIR)include -I$(MAN_DIR)include
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/motion/Makefile b/motion/Makefile
index 2b667ac1a44b2ab3f87f261801e7016b9601c6d8..9ae73caeec71a5fab7d21a5c1f6eadcaf301b7d1 100755
--- a/motion/Makefile
+++ b/motion/Makefile
@@ -15,7 +15,7 @@ INC_DIRS=-I./include/ -I$(DEV_DIR)include/ -I$(COMM_DIR)include/ -I$(CONT_DIR)in
LIBS=$(CONT_DIR)lib/libcontrollers.a $(COMM_DIR)lib/libcomm.a $(DEV_DIR)lib/libdyn_devices.a
-CFLAGS=-mmcu=$(MMCU) -Wall -O3 -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -O3 -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
ARFLAGS= rsc
diff --git a/motion/src/examples/Makefile b/motion/src/examples/Makefile
index b773bdda297cbb8fd4c54af7f4652636a4ec696a..d88b37124f3c8d0d9cdc6a5d45618bf5cfdc2f7b 100644
--- a/motion/src/examples/Makefile
+++ b/motion/src/examples/Makefile
@@ -18,7 +18,7 @@ LIBS=$(MAN_DIR)lib/libmotion_manager.a $(CONT_DIR)lib/libcontrollers.a $(COMM_DI
INCLUDE_DIRS=-I$(DEV_DIR)include -I$(COMM_DIR)include -I$(CONT_DIR)include -I$(MAN_DIR)include
-CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
+CFLAGS=-mmcu=$(MMCU) -Wall -Os $(defines) -DF_CPU=16000000UL -D__REAL__ -gdwarf-2 -std=gnu99 -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wstrict-prototypes
LDFLAGS=-mmcu=$(MMCU) -Wl,-Map=$(PROJECT).map -DF_CPU=16000000UL
diff --git a/motion/src/examples/main.c b/motion/src/examples/main.c
index fc603d7ccea8ec41e33a4b040ec3e2c12d754f47..eeab8f887cd049197119a8607ee6fc3ded923918 100644
--- a/motion/src/examples/main.c
+++ b/motion/src/examples/main.c
@@ -13,22 +13,22 @@ void user_loop(void)
{
if(is_action_running()==0x00)
{
- printf("Walk ready\n");
+ cm510_printf("Walk ready\n");
if(action_set_page(25)==0)
action_start_page();
else
- printf("Error loading page\n");
+ cm510_printf("Error loading page\n");
}
}
else if(is_button_falling_edge(BTN_RIGHT))
{
if(is_action_running()==0x00)
{
- printf("start walking\n");
+ cm510_printf("start walking\n");
if(action_set_page(26)==0)
action_start_page();
else
- printf("Error loading page\n");
+ cm510_printf("Error loading page\n");
}
}
else
@@ -37,7 +37,7 @@ void user_loop(void)
{
if(is_action_running())
{
- printf("stop action\n");
+ cm510_printf("stop action\n");
action_stop_page();
}
}