Merge pull request #32 from MasterPlayer/sw_processing

Fix issue #31
MasterPlayer · Jan 2, 2022 · 7465d98 · 7465d98
2 parents 8dac176 + 2638d9d
commit 7465d98
Show file tree

Hide file tree

Showing 7 changed files with 1,666 additions and 0 deletions.
diff --git a/src_sw/activity_intr/app.c b/src_sw/activity_intr/app.c
@@ -0,0 +1,104 @@
+#include <stdio.h>
+#include "platform.h"
+#include "xil_printf.h"
+#include "axi_adxl.h"
+#include <time.h>
+#include <xscugic.h>
+
+#include <xparameters.h>
+
+
+int scugic_initialize(XScuGic *ptr, axi_adxl* adxl_ptr);
+void adxl_intr_handler(void *callback);
+
+int main(){
+
+	init_platform();
+
+	axi_adxl adxl_device;
+	XScuGic gic;
+
+	axi_adxl_init(&adxl_device, 0x40030000, 0x40040000);
+
+	scugic_initialize(&gic, &adxl_device);
+
+	int status = axi_adxl_enable(&adxl_device, 0x53, 10);
+	if (status != ADXL_OK){
+		printf("[MAIN] : enable device return code [%d]\r\n", status);
+	}
+
+	status = axi_adxl_calibration(&adxl_device);
+	if (status != ADXL_OK){
+		printf("[MAIN] : calibration device return code [%d]\r\n", status);
+	}
+
+	status = axi_adxl_disable_requesting(&adxl_device);
+	if (status != ADXL_OK){
+		xil_printf("[MAIN] : disable requests return code : [%d]\r\n", status);
+		return 0;
+	}
+
+	axi_adxl_set_int_map(&adxl_device, ACTIVITY, 0x00);
+
+	axi_adxl_set_act_ctl(&adxl_device, DC_COUPLE, MASK_X | MASK_Y);
+	axi_adxl_set_thresh_act(&adxl_device, 0x10);
+
+	axi_adxl_int_enable(&adxl_device, ACTIVITY);
+
+	while(1){
+
+    }
+    cleanup_platform();
+    return 0;
+}
+
+
+
+
+int scugic_initialize(XScuGic *ptr, axi_adxl* adxl_ptr){
+
+	int status = 0;
+
+    XScuGic_Config *cfg;
+
+    cfg = XScuGic_LookupConfig(XPAR_SCUGIC_0_DEVICE_ID);
+    if (!cfg){
+        return XST_FAILURE;
+    }
+
+    status = XScuGic_CfgInitialize(ptr, cfg, cfg->CpuBaseAddress);
+    if (status != XST_SUCCESS){
+        return XST_FAILURE;
+    }
+
+    XScuGic_SetPriorityTriggerType(ptr, XPAR_FABRIC_AXI_ADXL345_VHD_0_ADXL_IRQ_INTR, 0x00, 0x3);
+
+    status = XScuGic_Connect(ptr, XPAR_FABRIC_AXI_ADXL345_VHD_0_ADXL_IRQ_INTR, (Xil_InterruptHandler)adxl_intr_handler, adxl_ptr);
+    if (status != XST_SUCCESS){
+        return XST_FAILURE;
+    }
+
+    XScuGic_Enable(ptr, XPAR_FABRIC_AXI_ADXL345_VHD_0_ADXL_IRQ_INTR);
+
+    Xil_ExceptionRegisterHandler(XIL_EXCEPTION_ID_INT, (Xil_ExceptionHandler)XScuGic_InterruptHandler, ptr);
+    Xil_ExceptionEnable();
+
+    return status ;
+}
+
+
+
+void adxl_intr_handler(void *callback){
+	axi_adxl *ptr = (axi_adxl*)callback;
+	adxl_cfg_ack(ptr->cfg);
+
+//	axi_adxl_debug(ptr);
+
+	g_coord g;
+
+	axi_adxl_get_gravity(ptr, &g);
+
+	printf("[x] : %3.3f \t[y] : %3.3f \t [z] %3.3f\r\n", g.x, g.y, g.z);
+	return;
+}
+