Starting to work on implementing algorithm

Signed-off-by: fisherjk <fisherjk@.uwec.edu>