public int ReadMaxWpts() { byte[] buffer = Read(Comandos.Ruta, 0xff, 0, 2); int i = 0; int numwpts = USBXpress.toint16(buffer, ref i); return(numwpts); }
public int[] ReadServosRAW() { byte[] buffer = Read(Comandos.SERVOS_RAW, 0, 0, 12 * 2); int[] servos = new int[buffer.Length / 2]; int i = 0; for (int j = 0; j < servos.Length; j++) { servos[j] = USBXpress.toint16(buffer, ref i); } return(servos); }