// dp.scale(1.0f/length);
Vector2f V = new Vector2f((float) Math.cos(originalAngle
+ body1.getRotation()), (float) Math.sin(originalAngle
+ body1.getRotation()));
Vector2f ndp = new Vector2f(dp);
ndp.normalise();
float torq = (float) Math.asin(MathUtil.cross(ndp, V))
* compressConstant / invDT;
float P = torq / length;
Vector2f n = new Vector2f(ndp.y, -ndp.x);
Vector2f impulse = new Vector2f(n);