Need help for building a pid controled robot

Please have a look at the PID library, and learn to use and tune it.

Good advice - IF you have any kind of good data to drive the PID algorithm.