Iterative template

Added C++ code from the FRC Iterative Template