Finished first part of bfs, uploading it so I can work on it at school