C code for controlling a soft robot using pressure feedback

C++ code for pressure feedback control of a soft snake like robot. The MCU is a teensy 3.5. Solenoid valves are two 12VDC/0.032/SS (1/8) NPT ports made by iQ Valves. Drivers are DRV something somethign from pololu.