Restructured a bit, got rid of calculate function. Waste of cycles.
Sample programs are working! Now to write my own...