Finished 3D Plotting and Functions