Simulation working without joints and with CoM at start of bones
Ball and socket joints implemented
Centering and scaling of skeletons is working