Well I think its solving but not updating the positions...

Need to fix draw method...