Filters Kalman, Vision or PID - the boat is sailing in a straight line

Everything is implemented using modern object-oriented methodologies and requires a C++ Standard Library (I wrote one of those too). Note PID design & implementation require knowledge of Control Theory and Engineering, and is not a "hack". A good intro can be viewed here: PID controller - Wikipedia. Cheers!!