Control of a tethered undersea kite energy system using a six degree of freedom model