private void SetBtnAction(object p)
{
var argList = new List <double>();
argList.AddRange(PID_roll.GetPID());
argList.AddRange(PID_pitch.GetPID());
argList.AddRange(PID_yaw.GetPID());
argList.AddRange(PID_depth.GetPID());
ModelContainer.jetsonClient.SendPIDs(argList.ToArray());
}
public void UpdatePIDS(float[] data)
{
if (data.Length != 16)
{
Console.WriteLine("PID data error");
return;
}
PID_roll.Update(data, 0);
PID_pitch.Update(data, 4);
PID_yaw.Update(data, 8);
PID_depth.Update(data, 12);
}