Good news: The distance joint works correctly, I have also added a circle class. Bad news: In order to make the new circle class I had to change shape(because of confict between x,y size and radius). Because of this PacketParser.cpp has been changed and may or may not work.