Refactored general code into Wethyr class. Coordinate system works perfectly. Upcoming updates will be mostly user and ui centric