Difference between revisions of "Others Extensions"
(→Range and bearing)
(→Firmware source code)
|Line 55:||Line 55:|
==Firmware source code==
==Firmware source code==
Revision as of 09:02, 17 December 2021
Range and bearing
The board allows situated agents to communicate locally, obtaining at the same time both the range and the bearing of the emitter without the need of any centralized control or any external reference. Therefore, the board allows the robots to have an embodied, decentralized and scalable communication system. The system relies on infrared communications with frequency modulation and is composed of two interconnected modules for data and power measurement.
The documentation and hardware files are available in the following links:
- Schematics (pdf)
- Assembling (pdf)
- Bill of Materials (xls)
- PCB (pdf)
- Hardware source files(zip)
- Fabrication: Gerber, pick and place, ... (zip)
- e-RandB manual (pdf)
- e-RandB firmware (zip)
- e-puck software and examples (tgz)
You can find more information about this board in the following links: http://www.e-puck.org/index.php?option=com_content&view=article&id=35&Itemid=23.
The following table lists the I2C the registers map:
Address Read Write 0 1 if data available, 0 otherwise - 1 data MSB - 2 data LSB - 3 bearing MSB - 4 bearing LSB:
double((MSB<<8)+LSB)*0.0001to get angle in degrees
- 5 range MSB - 6 range LSB - 7 max peak (adc reading) MSB - 8 max peak (adc reading) LSB - 9 sensor that received the data (between 0..11) - 12 - Set transmission power (communication range): between 0 (max range) and 255 (min range) 13 - data LSB (prepare) 14 - data MSB (send
16 - 0 store light conditions (calibration) 17 - 1=onboard calculation, 0=host calculation
Firmware source code
The code of the range and bearing extension is open source and is available as a git repository. To download the source code you need to install git on your system:
- Windows: downlaod git from https://gitforwindows.org/ and follow the installation instructions (default configuration is ok)
- Linux: issue the command
sudo apt-get install git
- Mac: issue the command
brew install git
The source code can downloaded with the command:
git clone https://github.com/gctronic/range_and_bearing_firmware.git
The command must be issued in
Git bash on Windows, or in a terminal on Linux / Mac.
This repository contains the main microcontroller factory firmware together with the e-puck2 library. This library includes all the functions needed to interact with the robot's sensors and actuators; the factory firmware shows how to use these functions.
A snapshot of the repository can be downloaded from e-puck2_main-processor_snapshot_17.03.20.zip.
A simple MPLAB project was created to let start using these modules. With the selector it's possible to choose whether the robot is an emitter (selector in position 0) or a receiver (selector in position 1). The receiver will send the information (data, bearing, distance, sensor) through Bluetooth.
The e-puck2 standard firmware contains a demo example to use the range and bearing extension. When the selector is in position 4 then the robot is the receiver, when in position 5 then the robot is the transmitter. The receiver will print (you need to connect the USB cable and open the USB serial port) the data received, the bearing, the distance and the sensor id; while the transmitter will send continously
You can download the pre-built firmware from e-puck2_main-processor_randb.elf; the source code is available form the repo https://github.com/e-puck2/e-puck2_main-processor.
Beware that the only communication channel available between the robot and the range and bearing extension is the I2C bus, the UART channel is not available with e-puck 2.
Once the robot is programmed with its factory firmware, you can get the values from the ground sensors through Bluetooth by putting the selector in position 3 and issueing the command
m that will return 5 values, the first 3 values are related to the ground sensors (left, center, right), the last 2 values are related to the cliff extension (if available).
For more information about the Bluetooth connection refer to section Getting started (e-puck1) or Connecting to the Bluetooth (e-puck2).
For more information about the Bluetooth protocol refer to section Advanced sercom protocol.
If you couple the e-puck extension for Gumstix Overo with the ground sensor refer to the section http://www.gctronic.com/doc/index.php/Overo_Extension#Ground_sensor to have an example on how to read the sensor values.
You can find more information about the ground sensors extension module in the following link http://www.e-puck.org/index.php?option=com_content&view=article&id=17&Itemid=18.
Assembly for e-puck2
- Unscrew the 3 spacers and remove the battery.
- Remove the top side from the case body gently.
- Detach the plastic camera adapter from the camera with the help of pliers; be careful to not stress the camera flex cable. Then you need to cut off the two protruding pieces (see 3.2) on the back of the plastic adapter; for this operation you can use nippers (see 3.3). Take the adapter (now is flat on the back as shown in 3.4) and insert it as before.
- Plug the ground module into its connector on the e-puck2; make the cable pass through the battery contact.
- First push the ground module within its slot in the body case, then slide in also the top side of the robot paying attention to the motors wires position: the back battery contact must remain between the body and motors wires and make sure the wires aren't stuck in the springs. Both the ground cable and camera flex cable must bend forming an "S" shape.
- Push the top all way down, then remount the spacers and plug in the battery. You're done.
The cliff module extends the capability of the groundsensor with two additional sensors placed in front of the wheels. One possible application is that the e-puck can now detect the end of a table and react accordingly. Moreover this module can be coupled with the automatic charger for the e-puck, that could let the robot autonomously charge itself when needed. The two spring contacts adapt only to the cliff module.
- Unscrew the 3 screws, unmount the e-jumper (top piece where there is the speaker) and unscrew the 3 spacers
- Remove the pcb from the case body gently
- Detach the two parts, cliff and ground pcb
- Plug the ground module into its connector on the e-puck
- Attach the cliff module to the ground module being careful to leave the battery contact in the middle
- Push the ground module within its slot in the body case, the cliff module will remain external
- Once both the modules are aligned, push them down
- The modules will remain really close to the case bottom; once the modules are fitted remount the spacers, the e-jumper and the screws
The circuit diagram of the e-puck cliff extension is available to the community on the following link electrical schema.
Refers to the section E-Puck Standard firmware for the firmware that need to be uploaded to the robot. Essentially the standard asercom demo (selector 3) released with the e-puck robot is extended in order to request and visualize 5 sensors values instead of 3 when issueing the m command; the sequence is: ground left, ground center, ground right, cliff right, cliff left. In order to enable the cliff sensors you need to define CLIFF_SENSORS in the asercom.c file in order to build the code parts related to this module.
To demonstrate the capabilities of the cliff sensors module here is an MPLAB project Demo-cliff-autocharge.zip that contains two demos:
- selector 0: in this demo the robot is eventually piloted to the charger station autonomously after moving around for some time aovoiding obstacles; the demo is shown in the video section.
- selector 1: this is a cliff avoidance demo in which the robot is moved forward until it detects the end of the table and tries to avoid it moving back and rotating; the demo is shown in the video section.
The ground sensor fimrware developed at EPFL (can be downloaded at the http://www.e-puck.org site from this page) was extended to interact with the additional two sensors. The source code can be downloaded from cliff-firmware; it is an MPLAB project and the MPLAB C Compiler for PIC18 MCUs is needed to build the project.
The communication between the e-puck and the module is handled through I2C (address 0xC0) and the following registers are defined:
- 0x00: reflected light, left IR sensor - high byte
- 0x01: reflected light, left IR sensor - low byte
- 0x02: reflected light, center IR sensor - high byte
- 0x03: reflected light, center IR sensor - low byte
- 0x04: reflected light, right IR sensor - high byte
- 0x05: reflected light, right IR sensor - low byte
- 0x06: ambient light, left IR sensor - high byte
- 0x07: ambient light, left IR sensor - low byte
- 0x08: ambient light, center IR sensor - high byte
- 0x09: ambient light, center IR sensor - low byte
- 0x0A: ambient light, right IR sensor - high byte
- 0x0B: ambient light, right IR sensor - low byte
- 0x0C: software revision number
- 0x0D: reflected light, right cliff sensor - high byte
- 0x0E: reflected light, right cliff sensor - low byte
- 0x0F: reflected light, left cliff sensor - high byte
- 0x10: reflected light, left cliff sensor - low byte
- 0x11: ambient light, right cliff sensor - high byte
- 0x12: ambient light, right cliff sensor - low byte
- 0x13: ambient light, left cliff sensor - high byte
- 0x14: ambient light, left cliff sensor - low byte
The same demo developed for the e-puck1 that let the robot autonomously reach the charging station and charge itself is available also for the e-puck2. You can find the source code in the following repository https://github.com/e-puck2/e-puck2_cliff_autocharge.
Robot equipped with the cliff sensor:
The robot can be easily moved to the charging station as shown in the following figure:
The following figure shows the two additional sensors (near the wheels) mounted on the cliff module and the three frontal sensors of the ground module: