Cleaned up code + first problem solver

Find max point method now works!