Finished diagonal search and submitted answer. Not really happy with this code, but it got the right answer