Added extraction of the joint positions and their visualization