i tried fixin it :D somewhat works now :/ what it basically does it just fire two points down from the bottom corners of the square onto the floor, then it find what the angle is with the first point pointing towards the second point to find the angle also i added jumping for testing
