Commented out test prints. Added tests. Needs efficiency tests.