added phugoid func.s and init vel/angle arrays