Control software for quadrupedal robots with a focus on tidy kinematics and motion. Includes sensor feedback
This repo contains the control software that runs my version of KDY0523's SpotMicro.
- Gait generation
- Structure of this repo
- Installation and execution
- Future work
- Hardware
- Additional resources
- parameterizable gait generator
- maintains stability
- static stability
- stability during slopes
- walking on "uneven" terrain using foot contact switches
- servo protection
- interactive menu
- simulation and state visualization for testing and during robot operation
The code if mainly written in Python, some parts (where speed matters) are rewritten to C++. I plan to convert most of the code successively and let only the high level control stay in Python.
The robot follows the conventions introduced in this book by Marc Raibert. The robot's gait can be altered in the state.py module by changing each leg's individual phase. If everything works right and the values are not in an extreme region, the control software should be able to maintain stability on its own.
quaro
│
├── Raspberry # software running on Raspberry Pi
│ ├── main.py
│ ├── src # general functionalities that can be applied on all quadruped robots
│ │ └── cpp # parts written in C++
│ │ └── ...
│ └── quaro # hardware specific functionalities for this certain robot
│ └── ...
│
├── Arduino # script for foot contact switch sensors
│
├── Simulation # plot of the robots state
│ └── main.py
│
├── notebooks # my notes on robot control
│
├── doc # definitions
│
├── media # images and videos
If you want to adopt this software for your own robot, you have to change the hardware-specific parameters in quaro/hardware_config.py. Changes for the robot operations are made in src/state.py
If you just want a simple, reliable quadruped control software in pure Python, download v3.1. The current version is rather a playground for my own experiments and sometimes unstable. (But it contains some cool features though)
Because this repo contains a submodule, it is necessary to use clone it with
the --recurse-submodules option:
git clone --branch master --recurse-submodules https://github.com/ThomasSchnapka/quaro.git
It is no problem to install the software without IMU, PWM-board or any hardware at all. The software detects which hardware is connected and creates a dummy instance if necessary.
The menu looks like this:
==============================================================
+------------------+
| QUARO-MENU |
+------------------+
--------------------------------------------------------------
support_ratio: 0.85 phase: [0. 0.5 0.5 0. ]
cycle_time: 1500.0 velocity: [0. 0.]
stab'_ratio: 0.5 rpy: [0. 0. 0.]
op'_hight: 0.9 true_com: [-28 0 0]
shoulder_dis': 1 swing_h'_fact':0.95
server_status':True ang'_velocity':0.0
stab'_ampl': 15
--------------------------------------------------------------
[QuaroServer] started server at 127.0.0.1 1276
[UserInterface] waiting for commands. Type 'h' for help.
[UserInterface]->
Most parameters can be changed during runtime. They are changed with change [parameter-name] [value]. Type in h as command to display the help. Please note that the values you provide are not checked for validity. However, the software should prevent damage to your robot as all servo angles are sanity checked. But there is no protection for resulting scratches.
- add a block diagram about the control software workflow in this repo
- implement IMU to close control loop
- controlled slope walking
- add foot contact switches similar to these
- develope a reliable way to sense foot contact while keeping the SpotMicro design
- be able to walk on uneven terrain
- implement dynamic model for Model Predictive Control
- understand MPC by building and controlling an inverted pendulum
- do offline trajectory optimization to counteract the inconvenient servo locations
- add a nice blinking light
long term:
- buy better actuators that can handle higher loads and give sensor feedback to enable closed-loop control
- build a big version
- Raspberry Pi 3
- 12 JX HV5932MG Servos
- PCA9685 servo board
- MPU6050 IMU
- customized SpotMicro parts with shoulder reinforcements
optional for foot contact switches:
- customized legs
- Arduino Nano
- Force Sensible Resistors (FSR)
- additional electronics
One of the biggest flaws of a quadruped robot on a budget is that the servo motors do not give any feedback. To deal with it I wanted to try out foot contact switches. After testing this approach with Phototransistors, I found out that using force-sensitive resistors is more feasible if one wants to maintain the Spot Micro design and avoid buying SMD boards. Instructions and files are available on Thingiverse. More information: link