Small QOL Update

- Fixed a bunch of bugs that were still outstanding.
- Using higher values for sub-stepping, should fix some cases where at low-framerate you can get slower speeds
- Reworked internal map structures, will make possible new map styles.