Updated version of final program

Added my subroutine and the print statements for testing. Everything is
ready except for the main loop and the calculations (which are not
correctly computing the quad formula).