Added test routine, but still working on it