Adding 3D matlab visualiazer
Adding issue 20 solution