diff options
Diffstat (limited to 'software')
| -rw-r--r-- | software/mpu/src/camera.c | 56 | ||||
| -rw-r--r-- | software/mpu/src/lightsens.c | 62 |
2 files changed, 118 insertions, 0 deletions
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;
+}
|