[Bug] Improve grapple/player interaction

[FranzPoize]

There is a lot of small issues with grapple:

• [x] - There is chattering when the player sometimes collides with a wall
• [ ] - There is a crash on vector out of range access
• [x] - Length of distance joint is still weird

[FranzPoize]

Vector out of range access is due to a negative incidentEdgeIndex this is probably the huge float subtraction however due to a poor debugger I haven't been able to confirm. This is pretty hard to trigger it seems on my computer so If you @Adnn stumble upon the crash (I wrote a subtle hint that the crash happened in the physic system)

spdlog::get("grapito")->error("IncidentEdge not found");
spdlog::get("grapito")->error("bodyRef: {} ", bodyRef);
spdlog::get("grapito")->error("bodyInc: {} ", bodyInc);
mEntityManager.addEntity(makeHudText("STOP#### There was a incidentEdge crash Please look at the log!!!!!!!!!!", {-300.f, 300.f}));

Please look at the log :)