00001
00002
00003 #include <config.h>
00004
00005
00006 #include <iostream>
00007 #include <cstdlib>
00008 #include <sys/time.h>
00009 #include <math.h>
00010
00011 #include "MessageHandler.h"
00012 #include "posix_message_queue.h"
00013 #include "posix_message_config.h"
00014 #include "observations.h"
00015 #include "Observer.h"
00016 #include "PlansysObservation.h"
00017 #include "BottleBoxSort.h"
00018 #include "BatterySort.h"
00019 #include "MotorAi.h"
00020 #include "FirstStrategy.h"
00021 #include "waypoint.h"
00022
00023
00024 #include "mainplansys.h"
00025
00026 int SendInitPosition( MessageHandler *navsysMessageHandler );
00027 int flashTheSensorBoardLeds( MessageHandler *proxysysMessageHandler );
00028 int askForCvObservation( MessageHandler *cvsysMessageHandler , int *counter );
00029 void recieveCollisionDetectionStruct(pmq_message *pm);
00030 void recieveCvObservaton(pmq_message *pm);
00031 void recieveCvColorObservaton(pmq_message *pm);
00032 void recievePositionUpdate(pmq_message *pm);
00033 void recieveWaypointReached(pmq_message *pm);
00034 void recieveProxyMessage(pmq_message *pm);
00035 void recieveCmdBatterySort(pmq_message *pm);
00036 void recieveCmdBottleBoxSort(pmq_message *pm);
00037 void recieveCmdProxyMessage(pmq_message *pm);
00038 void recieveCmdTeamColor(pmq_message *pm);
00039
00040 int waitForTeamColorMessage( MessageHandler *proxysysMessageHandler, MessageHandler *navsysMessageHandler );
00041
00042
00043