initial import of hatire by Furax49

Signed-off-by: Stanislaw Halik <sthalik@misaki.pl>

1 files changed, 31 insertions, 0 deletions

diff --git a/ftnoir_tracker_hatire/ftnoir_arduino_type.h b/ftnoir_tracker_hatire/ftnoir_arduino_type.h
new file mode 100644
index 00000000..4d19043b
--- /dev/null
+++ b/ftnoir_tracker_hatire/ftnoir_arduino_type.h
@@ -0,0 +1,31 @@
+#ifndef FTNOIR_TARDUINO_TYPE_H
+#define FTNOIR_TARDUINO_TYPE_H
+
+// Arduino trame structure
+#pragma pack(push,2)
+struct TArduinoData
+{
+	quint16  Begin;    // Header trame 0xAAAA;
+	quint16  Code;     // 0->999 Num Trame  >=2000  Info >=3000 Init  >=5000 Start Command  >=9000 Error 
+	float Gyro[3];  
+	float Acc[3];
+	quint16  End;     // End trame   0x5555;
+} ;
+#pragma pack(pop) 
+
+
+inline QDataStream & operator >> ( QDataStream& in, TArduinoData& out )
+{
+	in.setByteOrder(QDataStream::LittleEndian );  
+	in.setFloatingPointPrecision(QDataStream::SinglePrecision ); 
+
+	in >> (quint16)out.Begin  >> (quint16)out.Code 
+	   >> (float)out.Gyro[0] >> (float)out.Gyro[1]  >> (float)out.Gyro[2]	
+	   >> (float)out.Acc[0]  >> (float)out.Acc[1] 	 >> (float)out.Acc[2]
+	   >> (quint16)out.End;
+	return in;
+}
+
+
+
+#endif
\ No newline at end of file