Projet Drone de surveillance du labo TRSE (INGESUP)

Dependencies:   mbed PID ADXL345 Camera_LS_Y201 ITG3200 RangeFinder mbos xbee_lib Motor Servo

main.cpp

Committer:
Gaetan
Date:
2013-04-27
Revision:
32:74608bce78f6
Parent:
10:c8d73680b9fd
Child:
33:f85d47baaeb4

File content as of revision 32:74608bce78f6:

 /* Copyright (c) 2012 - 2013 Gaëtan PLEYBER
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR "AS IS" AND ANY EXPRESS OR IMPLIED 
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT 
 * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT 
 * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
 /*
 * Description
 * Input
 * Output
 */
 
/*
#include "mbed.h"
#include "mbos.h"

DigitalOut myled(LED1);

int main() {
    while(1) {
        myled = 1;
        wait(0.2);
        myled = 0;
        wait(0.2);
        
        //modification
    }
}*/

#include "mbed.h"                    
#include "mbos.h"
#include "os.h"


void task1(void);                       // task function prototypes
void task2(void);

DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
mbos os(2, 2);                          // Instantiate mbos with 7 tasks & 7 timer    


int main(void)
{
   // Configure tasks and timers
   os.CreateTask(TASK_COM, TASK_COM_PRIO, TASK_COM_STACK_SZ, task1);
   os.CreateTask(TASK_DETEC, TASK_DETEC_PRIO, TASK_DETEC_STACK_SZ, task2);
   /*os.CreateTask(TASK_MOUV, TASK_MOUV_PRIO, TASK_MOUV_STACK_SZ, task1);
   os.CreateTask(TASK_TRAJ, TASK_TRAJ_PRIO, TASK_TRAJ_STACK_SZ, task2);
   os.CreateTask(TASK_BATT, TASK_BATT_PRIO, TASK_BATT_STACK_SZ, task1);
   os.CreateTask(TASK_VIDEO, TASK_VIDEO_PRIO, TASK_VIDEO_STACK_SZ, task2);
   os.CreateTask(TASK_ARRET_URGENT, TASK_ARRET_URGENT_PRIO, TASK_ARRET_URGENT_STACK_SZ, task1);*/

   os.CreateTimer(TIMER_COM_ID, TASK_COM, TIMER_EVENT);
   os.CreateTimer(TIMER_DETEC_ID, TASK_DETEC, TIMER_EVENT);
   /*os.CreateTimer(TIMER_MOUV_ID, TIMER_MOUV_PERIOD, TIMER_MOUV_EVENT);
   os.CreateTimer(TIMER_BATT_ID, TIMER_BATT_PERIOD, TIMER_BATT_EVENT);
   os.CreateTimer(TIMER_VIDEO_ID, TIMER_VIDEO_PERIOD, TIMER_VIDEO_EVENT);
   os.CreateTimer(TIMER_ARRET_URGENT_ID, TIMER_ARRET_URGENT_PERIOD, TIMER_ARRET_URGENT_EVENT);*/

    // Start mbos
   os.Start();
    // never  return!
}

void task1(void)
{
    os.SetTimer(TIMER_COM_ID, TIMER_COM_PERIOD, TIMER_COM_PERIOD);
    while(1){
        os.WaitEvent(TIMER_EVENT);
        led1 = !led1;
        os.SetEvent(COMMUNICATION_EVENT, TASK_DETEC);
    }
}

void task2(void)
{
    os.SetTimer(TIMER_DETEC_ID, TIMER_DETEC_PERIOD, TIMER_DETEC_PERIOD);
    while(1){
        os.WaitEvent(TIMER_EVENT | COMMUNICATION_EVENT);
        /*switch(os.GetEvent()){
            case TIMER_EVENT:
                led2 = !led2;
            break;
            case COMMUNICATION_EVENT:
                led3 = !led3;
            break;
        }*/
        if(os.GetEvent() & TIMER_EVENT) led2 = !led2;
        if(os.GetEvent() & COMMUNICATION_EVENT) led3 = !led3;
   }
}