Adding 3D matlab visualiazer