Rough jumping in the works, added better drawing for groundPoints, added in test environment and ability to pause via "Esc"