public void SetServoPos(int Yaw, int Pitch) { byte[] DATA = new byte[2]; DATA[0] = (byte)Scale(Yaw, 0, 180, 0, 127); DATA[1] = (byte)Scale(Pitch, 0, 180, 127, 255); //serial.Write(DATA, 0, DATA.Length); }