Saint-Petersburg State University of Aerospace Instrumentation Robot Phoenix-Design Authors: Goncharov A. Miheev A. Jan 2007Saint-Petersburg State University of Aerospace Instrumentation Robot Phoenix-Design Authors: Goncharov A. Miheev A. Jan 2007
Saint-Petersburg State University of Aerospace Instrumentation Robot Phoenix-Design Authors: Goncharov A. Miheev A. Jan 2007
Saint-Petersburg State University of Aerospace Instrumentation Robot Phoenix-Design Authors: Goncharov A. Miheev A. Jan 2007
1
Introduction
24.01.2007: Phoenix-1 1 3 4 5 6 7 8 9 10 11 Project "Phoenix-1" was started 02/04/05 and was realized by mixed student and engineer team during autumn semester. Backbone of team is formed from students (4221 and 402student groups) and engineers of Student Design Center of SUAI. Mobile robot PHOENIX-1 orients in external environment with web-cam and has to follow a white stripe of the arbitrary shape
2
Control System of Robot
24.01.2007: Phoenix-1 1 2 4 5 6 7 8 9 10 11 Left and Right Motor Control Bridges RS-232 Web-camera Laptop Toshiba Controller ASK-Lab Rotation Speed Sensor -1 Rotation Speed Sensor -2 Actors Sensors High level Low level Laptop gets video images from web-camera and processes them. Controller gets data from speed sensors and sends them to laptop by RS-232 using protocol ASK-Bus 3.1. Backwards controller receives control commands from high-level program. Controller converts this control commands into executive signals to actors: PWM left, PWM right, Direction of rotation left, Direction of rotation right.
3
ASK-Lab Controller Architecture
24.01.2007: Phoenix-1 1 2 3 5 6 7 8 9 10 11 MULTIPROCESSOR ARHITECTURE - FOUR PIC18F458 CONNECTED WITH I2C CONTROLLER HAS FOUR EXTERNAL OPTO DECOUPLED BUSES FOR INDUSTRIAL INTERFACES LIKE RS232 / RS422 / RS485 A LOT OF PINS (ANALOG, INTERRUPT INPUTS, DIGITAL I\Os, PWM OUTPUTS) GIVE POSSIBILITIES TO HAVE LARGE AMOUNT OF PERIPHERY DEVICES
4
ASK-Lab Controller Appearance
24.01.2007: Phoenix-1 1 2 3 4 6 7 8 9 10 11 PIC Optron Interface Chip LED Buttons ASK-Lab Controller Interface and Power Module ASK-Lab controller is a universal solution for wide application area.
5
IDE “Constructor A3”
24.01.2007: Phoenix-1 1 2 3 4 5 7 8 9 10 11 DEVELOPER INTERFACE "Constructor A3" IDE MPLAB (Microchip,USA) MPLAB Standart Developer Interface Automatic Generated Code Microchip assembler High level algorithm description ; high prior form {RSi} task {USARTRecTimer} prior {high} period {5} cond {} ; low prior form {RSi} task {USARTRecInt} prior {low} maxdur {10} from {RSo} task {USARTSendInt} prior {low} maxdur {10} ; background form {RSi} task {USARTRec} prior {back} maxdur {10} cond {EnableFlag} from {RSo} task {USARTSend} prior {back} maxdur {10} cond {!(RunFlag)} Librarian Inter Task Information Exchange Viewer TARGET HARDWARE
6
Radio Control - 1
24.01.2007: Phoenix-1 1 2 3 4 5 6 8 9 10 11 Operator sees robot by his own eyesight and control movement of robot by control console by RF channel. Operator’s control commands are transmitted to robot’s controller, where they are converted to executive signal to actors (motors). Video from camera and sensors signals are written to laptop’s HDD. Later, the saved video and sensors information are used to teach neuron.
7
Radio Control - 2
24.01.2007: Phoenix-1 1 2 3 4 5 6 7 9 10 11 Video from camera is compressed and transmitted to operator’s PC by Wi-Fi. Simultaneously, video and sensors signals are written to laptop’s HDD. Operator sees video image and uses joystick to move the robot. Operator’s control commands are transmitted to robot’s laptop and are converted to executive signal for actors (motors). Later, the saved video and sensors information are used to teach neuron.
8
Comments