Added a simple test

Simple test implements the basics of Matt's algorithms