Teensy 4.1 Firmware for 5-Axis 3d-printed robot arm using steppers and encoders - View it on GitHub