Fixes and allowed for a point target to be none
Added basic PID control
Fixed PID control and removed unused scales