Skip to content
This repository has been archived by the owner on Sep 11, 2024. It is now read-only.

African-Robotics-Unit/boom-firmware

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

60 Commits
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 

Repository files navigation

Planarizing Boom Firmware

Build with PlatformIO

This firmware runs on the boom Teensy 4.0 and is responsible for estimating the state of the end of the boom and sending this over RS485 to the control computer. This project has been configured to work with PlatformIO.

Usage

Connect the board to the Speedgoat. The orange LED on the Teensy will come on for about 0.5 seconds and then turn off again. Do not move the boom during this time as this is the IMU being calibrated. Once the LED is off, lift the boom arm and the rotate the pivoting end (only if installed) past their encoder index points. Once the encoders have been indexed the orange LED will remain on. This means the boom is ready and is currently sending state data to the Speedgoat.

Connections

Communication

The boom uses RS485 at 1M baud to send data to the Speedgoat. Data frames are sent at 1kHz.

Speedgoat RS485 Connection

Signal Wire IO393 pin
5V Red 2b
0V Blue 1b
A (+) Green 5a
B (-) Yellow 6a

Data Frame

description bits type
header 16 0xAA55
x position 32 IEEE 754 Float
y position 32 IEEE 754 Float
ϕ position 32 IEEE 754 Float
x velocity 32 IEEE 754 Float
y velocity 32 IEEE 754 Float
ϕ velocity 32 IEEE 754 Float
x acceleration 32 IEEE 754 Float
y acceleration 32 IEEE 754 Float

Sensors

Pitch & Yaw Axis Encoders

Omron E6B2-CWZ6C Incremental 1024ppr

The pitch axis requires indexing at startup. The yaw axis is zeroed at startup.

Signal Wire Teensy pin
5V Brown -
0V Blue -
A Black 0 & 6
B White 1 & 7
Z Orange 2 & 8

Roll Axis Encoder (Optional)

Avago HEDS-5540#A06 Incremental 500ppr

The roll axis encoder is optional. It requires indexing at startup if it is connected. If it is disconnected the Teensy will just send its constant index offset value.

The Teensy 4.0 is only 3.3V tollerant so this encoder is powered with 3.3V rather than 5V. It seems to work fine.

Signal Wire Teensy pin
5V Red -
0V Black -
A Green 10
B Blue 11
Z Yellow 12

IMU

ST LSM9DS1 IMU

The IMU is calibrated at startup to ensure the y axis is always oriented vertically even if the pivoting end is not horizontal.

Signal Wire Teensy pin
3.3V Red -
0V Blue -
SDA Green 18
SCL Yellow 19

IMU Calibration

The IMU on the boom is calibrated on startup. This involves first finding the direction of the gravity vector and rotating the IMU frame so it aligns with the world frame. This is necessary as the boom tensioning cables do not guarantee that the end of the boom will be level with the ground, they only ensure that the angle it is set at remains constant. Once the orientation of the IMU has been saved, all of the axes are zeroed using the average from 1000 readings which takes approximately 0.5 seconds.

PLL Velocity Estimator

A PLL is used to compute a more accurate velocity estimate without timers on the signal lines. The PLL runs in an IntervalTimer with a priority of 1 to ensure consistent execution at 20kHz.

Releases

No releases published

Packages

No packages published

Languages