public void SaveToFlash()
{
byte[] buff = new byte[17];
int i = 0;
USBXpress.toarray(buff,ref i,(byte)singleton.txNumCanales);
USBXpress.toarray(buff,ref i,(Int16)singleton.txPeriodo);
USBXpress.toarray(buff,ref i,(Int16)singleton.txSeparador);
USBXpress.toarray(buff,ref i,(byte)(singleton.txPolarity?1:0));
USBXpress.toarray(buff,ref i,(byte)singleton.headtrack_panCh);
USBXpress.toarray(buff,ref i,(byte)singleton.servo_ch[(int)Singleton.Canales.PAN]);
USBXpress.toarray(buff,ref i,(byte)singleton.headtrack_tiltCh);
USBXpress.toarray(buff,ref i,(byte)singleton.servo_ch[(int)Singleton.Canales.TILT]);
USBXpress.toarray(buff,ref i,(float)singleton.uplinkValarm);
USBXpress.toarray(buff,ref i,(byte)(singleton.useEmisora?1:0));
if (singleton.enable_headtrack)
{
USBXpress.toarray(buff,ref i,(byte)(singleton.enable_pan ? 1 : 0));
USBXpress.toarray(buff,ref i,(byte)(singleton.enable_tilt ? 1 : 0));
}
WriteRAW(0xfc,buff);
}
public static int[] build_packet(byte id, float v)
{
int i = 0;
byte[] buff = new byte[4];
USBXpress.toarray(buff, ref i, v);
return(build_packet(id, buff));
}
public void SetLowBattery(float v) // obsoleto
{
byte[] buff = new byte[4];
int i = 0;
USBXpress.toarray(buff,ref i,v);
WriteRAW(0xfa,buff);
}
public static int[] SetLat(float lat)
{
int i = 0;
byte[] buff = new byte[4];
USBXpress.toarray(buff, ref i, lat);
return(build_packet((byte)REGS.Lat, buff));
}
public static int[] SetAltura(int altitude)
{
int i = 0;
byte [] buff = new byte[2];
USBXpress.toarray(buff, ref i, (Int16)altitude);
return(build_packet((byte)REGS.Altura, buff));
}
public void WriteMaxWpt(int num)
{
byte[] buffer = new byte[2];
int i = 0;
USBXpress.toarray(buffer, ref i, (Int16)num);
Write(Comandos.Ruta, 0xff, 0, buffer);
ClearScrIkarus();
PrintAtIkarus(3, 3, string.Format("Escritos {0} Wpts", num));
}
public static int[] SetDebugVar(byte var, float value)
{
byte dato = (byte)(var & 0x3f);
int i = 1;
byte[] buff = new byte[5];
seqid = (byte)((seqid + 1) & 0x03);
dato |= (byte)(seqid << 6);
buff[0] = dato;
USBXpress.toarray(buff, ref i, value);
return(build_packet((byte)0xF, buff));
}
public void WriteWpt(int id, string Name, float lon, float lat, float alt)
{
byte[] buffer = new byte[32];
int i;
for (i = 0; i < 20 && i < Name.Length; i++)
{
buffer[i] = (byte)Name[i];
}
for (; i < 20; i++)
{
buffer[i] = 0;
}
USBXpress.toarray(buffer, ref i, lon);
USBXpress.toarray(buffer, ref i, lat);
USBXpress.toarray(buffer, ref i, alt);
Write(Comandos.Ruta, (byte)id, 0, buffer);
}
