Rotation of joints, reading additional data and printing to screen now implemented