Added body and joint to model. Currently segfaults.