Implemented Problems 1-5

Problems 1-4 should be correct, Problem 5 may need slight adjustment.
Fixed typos in energy equations