SEAN O CONNELL / Mbed 2 deprecated mDot_LoRa_Sensornode

lora sensnode

Dependencies:   libmDot mbed-rtos mbed

Fork of mDot_LoRa_Sensornode by Adrian Mitevski

app/TaskAcceleration.cpp@1:e67174cc4953, 2016-08-10 (annotated)

Committer:
socie123
Date:
Wed Aug 10 12:54:10 2016 +0000
Revision:
1:e67174cc4953
Parent:
0:f2815503561f 
lora sensnode

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mitea1 0:f2815503561f 1 /*
mitea1 0:f2815503561f 2 * TaskAcceleration.cpp
mitea1 0:f2815503561f 3 *
mitea1 0:f2815503561f 4 * Created on: May 30, 2016
mitea1 0:f2815503561f 5 * Author: Adrian
mitea1 0:f2815503561f 6 */
mitea1 0:f2815503561f 7
mitea1 0:f2815503561f 8 #include "TaskAcceleration.h"
mitea1 0:f2815503561f 9
mitea1 0:f2815503561f 10 TaskAcceleration::TaskAcceleration(MPU9250* mpu9250,Mutex* mutexI2C, Queue<MPU9250AccelerationMessage,ACCELERATION_QUEUE_LENGHT>* queue){
mitea1 0:f2815503561f 11 this->mpu9250 = mpu9250;
mitea1 0:f2815503561f 12 setPriority(osPriorityNormal);
mitea1 0:f2815503561f 13 setStackSize(DEFAULT_STACK_SIZE);
mitea1 0:f2815503561f 14 setStackPointer(NULL);
mitea1 0:f2815503561f 15 setMutex(mutexI2C);
mitea1 0:f2815503561f 16 setQueue(queue);
mitea1 0:f2815503561f 17 }
mitea1 0:f2815503561f 18
mitea1 0:f2815503561f 19 TaskAcceleration::TaskAcceleration(MPU9250* mpu9250,rtos::Mutex* mutexI2C,rtos::Queue<MPU9250AccelerationMessage,ACCELERATION_QUEUE_LENGHT>* queue,
mitea1 0:f2815503561f 20 osPriority priority, uint32_t stackSize, unsigned char *stackPointer){
mitea1 0:f2815503561f 21 this->mpu9250 = mpu9250;
mitea1 0:f2815503561f 22 setPriority(priority);
mitea1 0:f2815503561f 23 setStackSize(stackSize);
mitea1 0:f2815503561f 24 setStackPointer(stackPointer);
mitea1 0:f2815503561f 25 setMutex(mutexI2C);
mitea1 0:f2815503561f 26 setQueue(queue);
mitea1 0:f2815503561f 27 setState(SLEEPING);
mitea1 0:f2815503561f 28 }
mitea1 0:f2815503561f 29
mitea1 0:f2815503561f 30 TaskAcceleration::~TaskAcceleration() {
mitea1 0:f2815503561f 31 // TODO Auto-generated destructor stub
mitea1 0:f2815503561f 32 }
mitea1 0:f2815503561f 33
mitea1 0:f2815503561f 34 osStatus TaskAcceleration::start(){
mitea1 0:f2815503561f 35 setState(RUNNING);
mitea1 0:f2815503561f 36 this->thread = new rtos::Thread(callBack,this);
mitea1 0:f2815503561f 37 }
mitea1 0:f2815503561f 38
mitea1 0:f2815503561f 39 osStatus TaskAcceleration::stop(){
mitea1 0:f2815503561f 40 thread->terminate();
mitea1 0:f2815503561f 41 setState(SLEEPING);
mitea1 0:f2815503561f 42 delete this->thread;
mitea1 0:f2815503561f 43 }
mitea1 0:f2815503561f 44
mitea1 0:f2815503561f 45 void TaskAcceleration::callBack(void const* data){
mitea1 0:f2815503561f 46 // WOODHAMMER METHOD of Casting!
mitea1 0:f2815503561f 47 const TaskAcceleration* constInstance = static_cast<const TaskAcceleration* >(data);
mitea1 0:f2815503561f 48 TaskAcceleration* instance = const_cast<TaskAcceleration*>(constInstance);
mitea1 0:f2815503561f 49
mitea1 0:f2815503561f 50 instance->measureAcceleration();
mitea1 0:f2815503561f 51 }
mitea1 0:f2815503561f 52
mitea1 0:f2815503561f 53 void TaskAcceleration::measureAcceleration(){
mitea1 0:f2815503561f 54 MPU9250AccelerationMessage mpu9250AccelerationMessage;
mitea1 0:f2815503561f 55
mitea1 0:f2815503561f 56 while(true){
mitea1 0:f2815503561f 57 mutexI2C->lock(osWaitForever);
mitea1 0:f2815503561f 58 mpu9250AccelerationMessage.setXAcceleration(mpu9250->getXAxisAcceleration());
mitea1 0:f2815503561f 59 mpu9250AccelerationMessage.setYAcceleration(mpu9250->getYAxisAcceleration());
mitea1 0:f2815503561f 60 mpu9250AccelerationMessage.setZAcceleration(mpu9250->getZAxisAcceleration());
mitea1 0:f2815503561f 61 mutexI2C->unlock();
mitea1 0:f2815503561f 62
mitea1 0:f2815503561f 63 queue->put(&mpu9250AccelerationMessage,osWaitForever);
mitea1 0:f2815503561f 64 osDelay(ACCELERATION_TASK_DELAY_MS);
mitea1 0:f2815503561f 65 }
mitea1 0:f2815503561f 66
mitea1 0:f2815503561f 67
mitea1 0:f2815503561f 68 }
mitea1 0:f2815503561f 69
mitea1 0:f2815503561f 70 void TaskAcceleration::setQueue(Queue<MPU9250AccelerationMessage,ACCELERATION_QUEUE_LENGHT>* queue){
mitea1 0:f2815503561f 71 this->queue = queue;
mitea1 0:f2815503561f 72 }
mitea1 0:f2815503561f 73
mitea1 0:f2815503561f 74 void TaskAcceleration::setMutex(Mutex* mutex){
mitea1 0:f2815503561f 75 this->mutexI2C = mutex;
mitea1 0:f2815503561f 76 }
mitea1 0:f2815503561f 77
mitea1 0:f2815503561f 78 void TaskAcceleration::setPriority(osPriority priority){
mitea1 0:f2815503561f 79 this->priority = priority;
mitea1 0:f2815503561f 80 }
mitea1 0:f2815503561f 81
mitea1 0:f2815503561f 82 void TaskAcceleration::setStackSize(uint32_t stacksize){
mitea1 0:f2815503561f 83 this->stack_size = stacksize;
mitea1 0:f2815503561f 84 }
mitea1 0:f2815503561f 85
mitea1 0:f2815503561f 86 void TaskAcceleration::setStackPointer(unsigned char* stackPointer){
mitea1 0:f2815503561f 87 this->stack_pointer = stackPointer;
mitea1 0:f2815503561f 88 }
mitea1 0:f2815503561f 89
mitea1 0:f2815503561f 90 void TaskAcceleration::setState(TASK_STATE state){
mitea1 0:f2815503561f 91 this->state = state;
mitea1 0:f2815503561f 92 }
mitea1 0:f2815503561f 93
mitea1 0:f2815503561f 94 TASK_STATE TaskAcceleration::getState(){
mitea1 0:f2815503561f 95 return state;
mitea1 0:f2815503561f 96 }
mitea1 0:f2815503561f 97