Finished Debugging the driver and made a basic main for testing