如何使用robotics编写PID走直线算法?有参考的程序吗?

如何使用robotics编写PID走直线算法?有参考的程序吗?