Computer simulation of a 3D, 3 link, diver with cross product driven PD control