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; } }