TODO's and Tests

Tested logic for finding start Snu.
Removed / Completed some TODO's