Basic clustering algorithm written, added test.py