Tuned PD parameters, Added live visualization, Added expermintal data