This video goes over the mathematical concepts of a PID program, how to program it, and also how to tune the program for your robot.
You can also learn this program and many more at https://ev3lessons.com/en/. This website can greatly improve your programming and building skills for FLL.