From 2252e04a485eee196c0cc2bff0e8f3b02e5eb313 Mon Sep 17 00:00:00 2001
From: Roland Sahlsten <Roland.Sahlsten.ASE10@fh-joanneum.at>
Date: Mon, 24 Oct 2011 21:10:53 +0000
Subject: git-svn-id: https://svn.spreadspace.org/mur.sat@181
 7de4ea59-55d0-425e-a1af-a3118ea81d4c

---
 software/mpu/src/camera.c    | 56 +++++++++++++++++++++++++++++++++++++++
 software/mpu/src/lightsens.c | 62 ++++++++++++++++++++++++++++++++++++++++++++
 2 files changed, 118 insertions(+)
 create mode 100644 software/mpu/src/camera.c
 create mode 100644 software/mpu/src/lightsens.c

(limited to 'software/mpu')

diff --git a/software/mpu/src/camera.c b/software/mpu/src/camera.c
new file mode 100644
index 0000000..4fad440
--- /dev/null
+++ b/software/mpu/src/camera.c
@@ -0,0 +1,56 @@
+/*
+ * camera.c
+ *
+ *  Created on: 23.10.2011
+ *      Author: Roland
+ */
+
+#include "Types.h"
+#include "FreeRTOS.h"
+#include "queue.h"
+
+#define	TASK_PRIORITY_camera		    ( tskIDLE_PRIORITY + 2 )
+#define TASK_STACK_SIZE_camera			( ( unsigned short ) 64 )
+
+/* Globals */
+static Task_Param_t TaskParam_Camera;
+
+/*
+ * Wake up other tasks, send them messages telling what to do,
+ * wait for them to have processed the commands or not, maybe
+ * put them to sleep again, ...
+ * */
+static void camera_Process_Task(void *Param)
+{
+	Message_t Msg;
+
+	if(NULL == TaskParam_Camera.QueueHandles.hxq_Camera)
+	{
+		return;
+	}
+	while(1)
+	{
+		if( xQueueReceive( TaskParam_Camera.QueueHandles.hxq_Camera,
+						   &Msg, portTICK_RATE_MS * 5 ))
+		{
+			/*
+			 * switch Msg.Sender
+			 *
+			 */
+			;
+		}
+	}
+}
+
+Status_t camera_Init_Camera(QH_t  hxQueues)
+{
+	TaskParam_Camera.QueueHandles = hxQueues;
+
+	if(!xTaskCreate( camera_Process_Task, (signed char *) "Camera",
+			TASK_STACK_SIZE_camera, &TaskParam_Camera,
+			TASK_PRIORITY_camera, &(TaskParam_Camera.hxTask_Self)))
+		return STATUS_ERROR_INIT;
+
+	/*TODO: check for success and pass it over to caller. */
+	return STATUS_OK;
+}
diff --git a/software/mpu/src/lightsens.c b/software/mpu/src/lightsens.c
new file mode 100644
index 0000000..230a0c3
--- /dev/null
+++ b/software/mpu/src/lightsens.c
@@ -0,0 +1,62 @@
+/*
+ * lightsens.c
+ *
+ *  Created on: 23.10.2011
+ *      Author: Roland
+ */
+
+#include "Types.h"
+#include "FreeRTOS.h"
+#include "queue.h"
+
+#define	TASK_PRIORITY_lightsens		    ( tskIDLE_PRIORITY + 2 )
+#define TASK_STACK_SIZE_lightsens			( ( unsigned short ) 64 )
+
+/* Globals */
+static Task_Param_t TaskParam_LightSens;
+
+/*
+ * Wake up other tasks, send them messages telling what to do,
+ * wait for them to have processed the commands or not, maybe
+ * put them to sleep again, ...
+ * */
+static void lightsens_Process_Task(void *Param)
+{
+	Message_t Msg;
+	portCHAR chBufLSe[10] = "Seas Knl!";
+
+	if(NULL == TaskParam_LightSens.QueueHandles.hxq_LightSens)
+	{
+		return;
+	}
+
+	Msg.Sender = Sender_LightSens;
+	Msg.pData = chBufLSe;
+	xQueueSend(TaskParam_LightSens.QueueHandles.hxq_Kernel, &Msg, MS(10));
+	while(1)
+	{
+		if( xQueueReceive( TaskParam_LightSens.QueueHandles.hxq_LightSens, &Msg, MS(5)))
+		{
+			/*
+			 * switch Msg.Sender
+			 *
+			 */
+			Msg.Sender = Sender_LightSens;
+			Msg.pData = chBufLSe;
+			xQueueSend(TaskParam_LightSens.QueueHandles.hxq_Kernel, &Msg, MS(10));
+		}
+	}
+}
+
+Status_t lightsens_Init_LightSens(QH_t  hxQueues)
+{
+	TaskParam_LightSens.QueueHandles = hxQueues;
+
+	if(!xTaskCreate( lightsens_Process_Task, (signed char *) "LightSensor",
+			TASK_STACK_SIZE_lightsens, &TaskParam_LightSens,
+			TASK_PRIORITY_lightsens, &(TaskParam_LightSens.hxTask_Self)))
+		return STATUS_ERROR_INIT;
+
+	/*TODO: check for success and pass it over to caller. */
+	return STATUS_OK;
+}
-- 
cgit v1.2.3