Tested this with oscilloscope. Looks like it's working as expected.
Got the tones generating now.
Everything working except the delay routine for some reason.
Got delay working.
Lab 5 done. Merging into master. Merge branch 'lab5'