Fixed velocity initialization bug; bodies now start from rest