Low pass filter working

Author: JamesTimothyMeech

benchmarks/source/superh/lowPassFilter/Makefile

@@ -0,0 +1,54 @@
+TREEROOT= ../../../..
+include $(TREEROOT)/conf/setup.conf
+
+TARGET= superH
+TARGET-ARCH= sh-elf
+
+PROGRAM= virtualSensorExample
+
+PORT= ../port
+LIBOS= mOS
+TOOLSLIB= $(TREEROOT)/tools/tools-lib
+INCLUDES= -I../port/ -I$(TREEROOT)/sys/include -I$(TREEROOT)/sys/kern/superH -I$(TREEROOT)/benchmarks/include -I$(TREEROOT)/sys/libOS/port
+OPTFLAGS= -gstabs3 -O0
+CFLAGS= $(TARGET-ARCH-FLAGS) -nostdlib -fno-builtin -Wall # Do not do since we are linking mOS for libc implementation:	-nostdlib -fno-builtin 
+LDFLAGS	= -Ttext $(LOADADDR) -TsuperH.ld -L$(TOOLSLIB)/$(TARGET) -L$(TREEROOT)/sys/libOS/$(LIBOS) -Map $(PROGRAM).map
+LOADADDR= 0x08004000
+
+
+OBJS=\
+init-$(TARGET).o\
+devrtc.o\
+misc.o\
+devsensor.o\
+$(PROGRAM).o\
+
+
+all:$(PROGRAM) $(PROGRAM).sr
+
+$(PROGRAM): $(OBJS)
+$(LD) $(LDFLAGS) $(OBJS) -o $@ -lc -lgcc -lm -l$(LIBOS)-$(TARGET)
+
+$(PROGRAM).sr:$(PROGRAM)
+$(OBJCOPY) -O srec $(PROGRAM) $@
+
+$(PROGRAM).o: $(PROGRAM).c Makefile
+$(CC) $(CFLAGS) $(OPTFLAGS) $(INCLUDES) -c $(PROGRAM).c
+
+devsensor.o: $(PORT)/devsensor.c Makefile
+$(CC) $(CFLAGS) $(OPTFLAGS) $(INCLUDES) -c $(PORT)/devsensor.c
+
+devrtc.o: $(PORT)/devrtc.c Makefile
+$(CC) $(CFLAGS) $(OPTFLAGS) $(INCLUDES) -c $(PORT)/devrtc.c
+
+misc.o: $(PORT)/misc.c Makefile
+$(CC) $(CFLAGS) $(OPTFLAGS) $(INCLUDES) -c $(PORT)/misc.c
+
+init-$(TARGET).o: init-$(TARGET).S
+$(CPP) init-$(TARGET).S > init-$(TARGET).i; $(AS) init-$(TARGET).i -o $@
+
+clean:
+$(RM) init-$(TARGET).i *.o $(PROGRAM) $(PROGRAM).sr $(PROGRAM).map
+
+install: all
+cp $(PROGRAM).sr ../../../

benchmarks/source/superh/lowPassFilter/asm.h

@@ -0,0 +1 @@
+#defineMOVLMOV.L

benchmarks/source/superh/lowPassFilter/init-superH.S

@@ -0,0 +1,38 @@
+#include "asm.h"
+
+/*fake errno*/
+.global___errno
+.global _sleep
+
+.align2
+start:
+/*Clear Status Reg*/
+AND#0, r0
+LDC	r0, sr
+
+/*Go !*/
+
+MOVL	stack_addr, r15
+MOVL	start_addr, r0
+JSR	@r0
+NOP
+
+/*SYSCALL SYS_exit*/
+mov#1, r4
+trapa	#34
+
+
+.align2
+/*Stack is 64M above us*/
+stack_addr:
+.long	(0x8001000 + 1<<26)
+start_addr:
+.long	_main
+
+___errno:
+.long0
+
+_sleep:
+SLEEP
+RTS
+NOP

benchmarks/source/superh/lowPassFilter/run.m

@@ -0,0 +1,23 @@
+v
+
+--
+--
+--
+setquantum	1
+setfreq 40
+--	All signals have sample rate 400 to simulate the 400 Hz acceleromter used to collect them, interpolation is off and we aren't using location data
+--	Tell sunflower where to find x-axis acceleration readings
+sigsrc	0 "X-Axis Acceleration"	0.0 0.0	1.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0	0.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0	" "	0 0.0 0.0 0.0 0	"xAcceleration.txt" 400 1 0 0
+--
+--	Node 0
+--
+cacheoff
+-- subscribe to all three signals with a seperate virtual sensor for each
+sigsubscribe	0 0
+sizemem	96000000
+srecl	virtualSensorExample.sr
+run
+setrandomseed	936977
+setnode	0
+v
+on

benchmarks/source/superh/lowPassFilter/superH.ld

@@ -0,0 +1,40 @@
+OUTPUT_FORMAT("coff-sh")
+OUTPUT_ARCH(sh)
+SECTIONS
+{
+.text . :
+{
+_text = . ;
+*(.text)
+*(.strings)
+_etext = . ;
+}
+.tors :
+{
+___ctors = . ;
+*(.ctors)
+___ctors_end = . ;
+___dtors = . ;
+*(.dtors)
+___dtors_end = . ;
+}
+.data . :
+{
+_data = . ;
+*(.data)
+*(.gcc_exc*)
+___EH_FRAME_BEGIN__ = . ;
+*(.eh_fram*)
+___EH_FRAME_END__ = . ;
+LONG(0);
+_edata = . ;
+}
+.bss . :
+{
+_bss = . ; 
+*(.bss)
+*(COMMON)
+_ebss = . ;
+_end = . ;
+}
+}

benchmarks/source/superh/lowPassFilter/virtualSensorExample.c

@@ -0,0 +1,71 @@
+/* 
+ *	Aya Helmy wrote this example for her 4B25 coursework. 
+ *	James Meech adapted it to run over sunflower and take input from the sigsrc command.
+ */
+#include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include <limits.h>
+#include <stdbool.h>
+#include "sf-types.h"
+#include "tag.h"
+#include "devsim7708.h"
+#include "sh7708.h"
+#include "devscc.h"
+#include "devrtc.h"
+#include "devexcp.h"
+#include "devlog.h"
+#include "devloc.h"
+#include "devsensor.h"
+#include "misc.h"
+#include "print.h"
+
+float LowPassFilter(float *in, float *out, int N, double in0)
+{
+out[0] = in[0] + in0;
+for (int n=1; n < N ; n++) 
+{
+out[n] = in[n] + in[n-1];
+}
+return in[N-1];
+}
+
+int
+main(void)
+{
+const int numberOfSamples = 30;
+int halfNumberOfSamples = numberOfSamples/2;
+float xBuffer[numberOfSamples];
+float xBufferOut[numberOfSamples];
+float in0 = 0;
+for(int j = 0; j < numberOfSamples; j++)
+	{
+/* 
+ * Insert delay of 2500 uSeconds to simulate 400 Hz sample rate
+ */ 
+xudelay(2500);
+/* 
+ * Read sensor readings from sigsrc 0 which is the x-axis accelerometer readings
+ */
+ xBuffer[j] = devsignal_read(0);
+/*
+ *	Please note that sigsrc simulates a real signal which changes in time. 
+ *	The value returned by devsignal_read() will be different at different simulation times.
+ *	Here we use delay to wait for 1/f seconds where f is the 400 Hz sample frequency specified in the run.m file. 
+ *	If we don't wait for this amount of time and instead sample as quickly as we can we will see the same sensor value many times. 
+ *	If we set xudelay to a higher value we will start to miss some samples in the file as we are looking at the return value of i
+ *	devsignal_read() at a frequency lower than 400 Hz.
+ */
+	}
+
+in0 = LowPassFilter(xBuffer, xBufferOut, halfNumberOfSamples, in0);
+in0 = LowPassFilter(&xBuffer[halfNumberOfSamples], &xBufferOut[halfNumberOfSamples], halfNumberOfSamples, in0);
+
+for(int i = 0; i < numberOfSamples; i++)
+{
+printf("x[%d]=%f\ty[%d]=%f\n",i,xBuffer[i], i, xBufferOut[i]);
+}
+
+return 0;
+}
+