added calc_bez_xyz

calc_bez_xyz is  the same calc_bez_xy but in 3d