This repository contains firmware for the SVEA Powerboard 2. PlatformIO is used to build and upload the firmware. Instructions and scripts for installing PlatformIO together with other dependencies are included in this repository. See the Setup section for further instructions.
Structure of the repository
Instructions for seting up the software required to flash the board.
How to flash the board, and use the different targets.
An overview of the features in the firmware.
Published and subscribed topics, and how they should be interpreted.
This folder contains the source code for the firmware
Contains libraries
There are three options for how to install platformIO. The two first options will create a virtual environment for PlatformIO. The last option will install the PlatformIO library directly with your other python libraries.
Recommended for development
git clone this repository to a folder on your computerconda deactivatebash init.shRecommended for just flashing new firmware
git clone this repository to a folder on your computerconda deactivatepython3 -c "$(curl -fsSL https://raw.githubusercontent.com/platformio/platformio/master/scripts/get-platformio.py)"bash init.shgit clone https://github.com/kth-sml/svea_lli_firmware
cd svea_lli_firmware
python3 -m venv venv
. venv/bin/activate
pip install -r requirements.txt
./init.sh
pio run -t uploadsource ~/.platformio/penv/bin/activatepio run -t uploadVS Code can be used to build and upload the firmware to the Powerboard if the PlatformIO plugin is installed.
There are 5 different environemnts defined in platformio.ini.
The difference between these environemnts is how the rosserial libraries are created.
The environment can be set with the -e flag, e. g. -e *environment name*.
The default environement.
Uses the rosserial libraries included in lib/ros_included.
This is the environment that runs if no
--environment or -e argument is passed to pio run.
This environment is can be used if no messages defintions have been added or changed.
Note that most of the standard message defitions,
like std_msgs, geometry_msgs, and nav_msgs are already included.
Build the rosserial libraries from the currently sourced ROS workspaces.
Rosserial and all required message definitions have to be included
in these workspaces, or the compilation will fail.
Intended to be used for development where messages have been added
or altered on the current machine.
The newly built rosserial libraries will be placed in a folder named
lib/ros_local.
Note: This environment generates rosserial messages, but does not build the workspaces.
The workspaces will have to be built manually for any changes to message definitions to take effect.
Same as use_included_libs but will use
rosserial libraries located in lib/ros_local
(previously generated by build_local_libs), instead of lib/ros_included.
Download both rosserial and all messages from the vehicle_msgs repository,
build them and place the rosserial library in lib/ros_remote.
Some temporary ROS workspaces will be placed in a tmp folder in the root of the repository.
Same as use_included_libs but will use
rosserial libraries located in lib/ros_remote instead
(previously generated by download_and_build_remote_libs), instead of lib/ros_included.
This is a summary of the features that are implemented in the firmware. Some features that are not implemnted, but is supported by the hardware are also listed under Not Implemented.
PWM reading
Up to five pwm signals from a receiver can be read and translated to acuation values.
PWM actuation
PWM signals can be sent to steering, velocity, gear, and differential locks.
ROS connection
The firmware can communicate with a ROS network over rosserial. See the ROS Related section for details.
On board LEDs
The four on board LEDs can be controlled by the Teensy. Currently the colors represent:
If the remote is disconnected and ROS is inactive the LED will go into disco mode.
Servo Power off on idle
Power to the servos will be cut if the remote is disconnected, and nothing is being sent through ROS.
Emergency Breaking
An emergency break can be initiated trough ROS. All other actuation will be ignored until the emergency is cleared.
Steering calibration
The steering can be calibrated with the remote. Initiate callibration by holding down button 0 for 1 second. The LEDs should turn yellow. Now turn the tires as far to the left as they can go without pushing against the chassis. Push button 0 again. The LEDs should turn blue. Turn the tire as far to the right as they can go without pushing against the chassis. Push button 0 again and the LEDs should blink for a short while. The callibration is complet and the values have been saved to flash.
External LEDs
External LED connectors are available on the SPMB2, however these are currently not supported by the firmware.
Power measurements through INA260
There is a INA260 power sensor on the SPMB2 that can be used to measure the power consumed by the powerboard (excluding servos). The INA260 is connected to I2C1 on the Teensy.
The following topics are subscribed to and published on by the firmware.
lli/actuation_request ([svea_msgs/lli_actuation.msg])
Takes request for an actuation to be set.
If nothing is published for SW_TIMEOUT milli seconds,
the ROS actuation will be considered idle.
If the remote is not activem the acuation will go idle,
otherwise control will be handed over to the remote.
Values of -128 are treated as do not change i.e. whichever value
that was previously actuated will continue to be actuated.
The ctrl field has no effect except that it can be used to trigger
a response on lli/actuated by changing the flags instead of the actuation values.
lli/emergency ([svea_msgs/lli_emergency.msg])
Emergency brake which will override other actuation requests. If the value of the message is True, the vehicle will break and ignore any further input until either:
EMERGENCY_T_CLEAR_LIMIT has passed and the remote is in
the override position.lli/actuated ([svea_msgs/lli_actuation.msg])
The currently actuated values will be published here, independent of source. Values will only be published if there is a change. No new message will be published if an actuation value is received that is identical (same stering, velocity, gear, differential locks, and control flags) to the one already being actuated.
The first four bits in the ctrl value represents
lli/remote ([svea_msgs/lli_actuation.msg])
Readings from the remote. The control flags are the same as for lli/actuated.
lli/encoder ([svea_msgs/lli_encoder.msg])
Encoder tics and time intervals for each wheel if encoders are mounted. If no encoders are mounted, zeero readings will still be published.
Any contribution is welcome. If you find missing instructions or something did not work as expected please create an issue and let me know.
See the LICENSE file for details of the available open source licensing.