Arm PID works and implemented the top soft stop

4th change might not work (adding 1 to the prevArm val)