[SFML] [Fizyka 2D] Fizyka platformówki - problem

// makra do obsługi wyliczeń bitowych
#define ENUM_ADDVAL(e, val) e = (decltype(e)) ((unsigned)e | (unsigned)(val))
#define ENUM_REMOVEVAL(e, val) e = (decltype(e)) ((unsigned)e & ~((unsigned)(val)))
#define ENUM_ISVAL(e, val) ((unsigned)e & (unsigned) (val))

//...

class Collision
{
public:
   
private:
    FloatRect r1, r2;
    bool coll;
   
    void collision();
   
public:
   
    Collision( FloatRect rr1, FloatRect rr2 );
    Collision( Sprite & t1, Sprite & t2 );
    Collision( Object & ob1, Object & ob2 );
   
    operator bool() const { return coll; }
    FloatRect get1Rect() const { return r1; }
    FloatRect get2Rect() const { return r2; }
   
    void recompute() { collision(); }
};

//...

class Player
{
public:
    //...
   
    class Jump
    {
        float jmpH; // [px]; wysokość
        float jmpG; // [px/s]; grawitacja
        Time cmlT; // czas skumulowany;
        float startY; // [px]; wysokość startowa
        float currY; // [px]; wysokość aktualna
        float relativeY; // [px]; wysokość aktualna; względna do startY; odwócona oś
    public:
        Jump( float starty, float jmph, float gravity = 1200.0f );
       
        void update( Time elapsed );
       
        float getY() const { return currY; }
        float getStartY() const { return startY; }
        float getJmpH() const { return jmpH; }
        float getRelativeY() const { return relativeY; }
    };
   
    class Fall
    {
        float falG; // [px/s]; grawitacja
        Time cmlT; // czas skumulowany
        float startY; // [px]; wysokość startowa
        float currY; // [px]; wysokość aktualna
       
    public:
        Fall( float starty, float gravity = 1200.0f );
       
        void update( Time elapsed );
       
        float getY() const { return currY; }
        float getStartY() const { return startY; }
        Time getCmlTime() const { return cmlT; }
    };
   
   
    enum Move
    {
        Left,
        Right,
    };
   
    enum class Dir
    {
        Up = 1,
        Down = 1 << 1,
        Left = 1 << 2,
        Right = 1 << 3,
       
        None = 0,
    };
   
    //...
   
   
private:
    //...
   
    Jump * jmp; // pam. wolna; tworzone przez jump(), zawiera dane skoku
    Fall * fall; // pam. wolna; tworzone podczas spadania, zawiera dane spadania
    unsigned dir; // aktualny kierunek
   
    //...
   
    bool onGround; // czy stoi na ziemi?
    bool onGroundCall; // odpytywanie wywołań onCollision(): kolizja od dołu
   
    //...
   
    void stopJmp() { if( jmp ) { delete jmp; jmp = NULL; ENUM_REMOVEVAL( dir, Dir::Up ); ENUM_REMOVEVAL( dir, Dir::Down ); } }
    void stopFall() { if( fall ) { delete fall; fall = NULL; ENUM_REMOVEVAL( dir, Dir::Down ); } }
    void startFall() { fall = new Fall( getPosition().y ); }
public:
    Player( Vector2f pos );
   
    //...
   
    Vector2f getPosition() const { return sp.getPosition(); }
    void setPosition( Vector2f pos ) { sp.setPosition( pos ); }
    Vector2f getSize() const { return Vector2f( sp.getGlobalBounds().width, sp.getGlobalBounds().height ); }
    //...
    void onCollision( Collision & c );
};

//...

void Player::onCollision( Collision & c )
{
    Vector2f pos = getPosition();
   
    if( ENUM_ISVAL( dir, Dir::Down ) || onGround )
    // kolizja od dołu
    {
        // zakończ skok i spadanie (jeśli są)
        if( jmp )
        {
            delete jmp;
            jmp = NULL;
        }
        if( fall )
        {
            delete fall;
            fall = NULL;
        }
       
        // usuń spadanie
        ENUM_REMOVEVAL( dir, Dir::Down );
       
        onGround = true;
       
        // wyrównaj do góry obiektu
        pos.y = c.get1Rect().top - getSize().y;
    }
   
    if( ENUM_ISVAL( dir, Dir::Up ) )
    {
        if( jmp )
        {
            delete jmp;
            jmp = NULL;
        }
       
        ENUM_REMOVEVAL( dir, Dir::Up );
        ENUM_ADDVAL( dir, Dir::Down );
       
        pos.y = c.get1Rect().top + c.get1Rect().height;
        fall = new Fall( pos.y );
    }
   
    setPosition( pos );
}

//...

// odbijanie się od dołu platformy
if( ENUM_ISVAL( dir, Dir::Up ) )
{
    if( jmp )
    {
        delete jmp;
        jmp = NULL;
    }
   
    ENUM_REMOVEVAL( dir, Dir::Up );
    ENUM_ADDVAL( dir, Dir::Down );
   
    pos.y = c.get1Rect().top + c.get1Rect().height;
    fall = new Fall( pos.y );
}

//// algorytm kolizji @RazzorFlame
else if( abs( old.x - pos.x ) < abs( old.y - pos.y ) )
{
    onGroundCall = true;
   
    // zakończ skok i spadanie (jeśli są)
    stopJmp();
    stopFall();
   
    // usuń spadanie
    ENUM_REMOVEVAL( dir, Dir::Down );
   
    onGround = true;
   
    // wyrównaj do góry obiektu
    pos.y = c.get1Rect().top - getSize().y;
}
else
{
    sf::Vector2f offset; //obiekt pomocniczy
    offset.x = pos.x - obj.left;
    offset.y = pos.y - obj.top;
    if( offset.x < obj.width / 2 )
    {
        ENUM_REMOVEVAL( dir, Dir::Right );
        startFall();
        st = NoMove; // nie przesuwaj sie ani w lewo ani w prawo
        pos.x = obj.left - this->getSize().x; // wyrównanie
    }
    else
    {
        ENUM_REMOVEVAL( dir, Dir::Left );
        startFall();
        st = NoMove; // nie przesuwaj się ani w lewo ani w prawo
        pos.x = obj.left + obj.width; // wyrównanie do prawej
    }
}