Add pseudocode and actual code to repo