ThadHouse Fixes PID controller OnTarget bug and adds unit test for it

Users who have contributed to this file

• ThadHouse