#include <iostream>
#include <armadillo>
#include <time.h>
#include <stdio.h>
#include <stdlib.h>
#include "GPM.h"

using namespace std;
using namespace arma;

int alpha2LD_HCV(vec alpha_rad, vec Rou, vec Ma, vec V, auxdata1 auxdata, vec* L, vec* D) {
	vec Alpha = alpha_rad / datum::pi * 180;

	vec CL0 = -0.05454 + 0.01106*Ma - 0.01732*Alpha + 0.06245*Ma%Alpha - 0.06107*Ma%Alpha - 6.437e-4*Ma%Ma - 0.2133e-3*Alpha%Alpha - 5.249e-5*Ma%Alpha%Alpha;

	vec CLA = 0.04419 - 0.006397*Ma + 0.5084e-3*Alpha - 2.611e-5*Ma%Alpha + 0.2912e-3*Ma%Ma - 3.388e-6*Alpha%Alpha + 2.944e-6*Ma%Alpha%Alpha;

	vec CD0 = 0.04856 + 0.001252*Ma + 0.002765*Alpha + 3.813e-6*Ma%Alpha - 2.592e-4*Ma%Ma - 0.9793e-3*Alpha%Alpha + 3.355e-5*Ma%Alpha%Alpha;

	vec CDA = 0.0009103 - 9.36e-4*Ma + 0.7493e-3*Alpha - 3.965e-5*Ma%Alpha + 6.132e-5*Ma%Ma + 1.942e-5*Alpha%Alpha - 2.659e-7*Ma%Alpha%Alpha;
	*D = CD0 + CDA%Alpha;
	*L = CL0 + CLA%Alpha;
	return 1;
}
// 动力学方程积分部分
// 输入：	H:  高度变量
//			V:  速度变量
// 输出：	Rou：大气密度
//			Ma:  马赫数
// 方法：无
// 编写：李兆亭
// 时间：2020 / 11 / 12