fix: change range of phi, theta (not really necessary for PCC control…
Created by: Yasu31
… but should be considered in PID control so values don't jump around)
fix: phi of actual curvature will be used in actuate() in SoftArm.cpp, if theta is large enough