NotWorking: Changed the functions to template hpp format.  Try to see how to fix this without libraries