Created Joint and BodyPart classes. Basic testing in main.cpp