+ Fixed matrix scaling functions
+ More tweaks to collision detection