1 files changed, 22 insertions, 0 deletions
diff --git a/GEOLOC/app/frame.c b/GEOLOC/app/frame.c
new file mode 100644
index 0000000..1908075
--- /dev/null
+++ b/GEOLOC/app/frame.c
@@ -0,0 +1,22 @@
+#include "frame.h"
+
+
+void pushFrame(Frame frame){
+	writeReg(REG_FIFO, frame.id);
+	writeReg(REG_FIFO, frame.stamp);
+	int i;
+	for(i=0;i<FRAME_DATA_SIZE;i++){
+		writeReg(REG_FIFO,frame.data[i]);
+	}
+}
+
+Frame pullFrame(){
+	Frame frame;
+	frame.id=readReg(REG_FIFO);
+	frame.stamp=readReg(REG_FIFO);
+	int i;
+	for(i=0;i<FRAME_DATA_SIZE;i++){
+		frame.data[i]=readReg(REG_FIFO);
+	}
+	return(frame);
+}