Add Controller Gains.

Add controller gains template files, generation script, and short test.
Remove unnecessary includes.
WIP: Initial firmware implementation of controller.