Use correct error calculation in PI and PID Controllers#11

calebfletcher merged 3 commits into

calebfletcher:maincalebfletcher/foc:mainfrom

phycrax:fix_pid_errorphycrax/foc:fix_pid_errorCopy head branch name to clipboard