Colony

#ifndef TRAFFIC_NAVIGATION_H

#include <dragonfly_lib.h>

#include <wl_basic.h>

#include "../linefollowing/lineDrive.h"

#include "highways.h"

#include "intersectData.h"

#include "validTurns.h"

/* Debug Options */

#ifdef DEBUGALL

#define ORB_HIGHWAY

#define ORB_LINEFOLLOW

#define ORB_INTERSECTON

#define DEBUG_CA

#define DEBUG_INTERSECTION

#endif

/*States*/

#define SROAD 0

#define SINTERSECTION 9 /* for old version */

#define SINTERSECTION_ENTER 10

#define SINTERSECTION_ENTER_RESOLV 11

#define SINTERSECTION_WAIT 12

#define SINTERSECTION_DRIVE 13

#define SHIGHWAY 20

#define SCLEARPACKET 30

/*Sign Codes

 * bitwise OR labels to create a barcode or read one

 * There should be macros to extract these probably

 * The bits will be stored in some variable (char or short)

 * Bits if road: ? ? ? NAME NAME NAME TYPE CROAD

 * Bits if intersection: ? ? ? ? DIR DIR #WAYS CINTERSECTION

 */

#define CROAD 0x0 //0b

#define CINTERSECTION 0x1 //1b

#define CNORMALROAD 0x0 //00b

#define CHIGHWAYROAD 0x2 //10b

#define C4WAY 0x0 //00b

#define C3WAY 0x2 //10b

#define CNORTH 0x0 //0000b

#define CEAST 0x4 //0100b

#define CSOUTH 0x8 //1000b

#define CWEST 0x12 //1100b

/*Wireless Packet Types

 * The first byte of any wireless packet should be one of these types.

 * Each type will have its own structure

 * The second byte should be the id of the bot sending the packet

 * The third byte should be the number of the intersection or road that

 *   the packet pertains to

 */

#define PACKET_LENGTH 5

#define WROADENTRY 0 //[type, bot, road]

#define WROADREPLY 1 //[type, fromBot, road, toBot]

#define WROADEXIT 2 //[type, bot, road]

#define WROADSTOP 3 //[type, bot, road]

#define WINTERSECTIONENTRY 10   //[type, bot, intersection, fromDir, toDir]

#define WINTERSECTIONREPLY 11   //[type, fromBot, intersection, toBot]

#define WINTERSECTIONEXIT 12    //[type, bot, intersection]

#define WINTERSECTIONGO 13      //[type, bot, intersection]

#define WINTERSECTIONPOLICEENTRY 14

#define WINTERSECTIONRESOLVERACE 15   //[type, bot, intersection, num]

#define WHIGHWAYENTRY 20 //[type, bot, highway]

#define WHIGHWAYREPLY 21 //[type, fromBot, highway, toBot]

#define WHIGHWAYEXIT 22 //[type, bot, highway]

#define WPINGGLOBAL 30 //[type, bot]

#define WPINGBOT 31 //[type, fromBot, toBot]

#define WPINGQUEUE 32 //[type, fromBot, toBot]

#define WPINGREPLY 33 //[type, fromBot, toBot]

#define WCOLLISIONAVOID 41 //[type, bot, intersection, collision-int] //Note: collision is an int and thus takes two spaces

/*Wireless Parsing Status

 * For wireless parsing - status codes describing various errors/statuses with wireless

 * parsing. 

 * Errors begin with E - Note that all of these errors are actually returned as negative.

 *                     - values of >= 100 indicate a serious error

 * Non-Errors begin with K - returned as positive. (don't start with S because S

 *                           is for state)

 */

#define ENOPACKET -10 //The received packet doesn't exist.

#define ENOACTION -15 //The received packet has no defined action, and this is OK

#define ENOIMPLEMENT -20 //The received packet has no defined action and needs to be implemented.

#define EPACKETLEN -100 //The received packet was the wrong length

#define KOK 1

#define KPLACEDINQUEUE 20

#define KFAILEDTOQUEUE 21

#define KFIRSTINQUEUE 22

#define KREPLIEDTOENTER 23

#define KRESOLVINGENTER 24 //resolving a race between bots trying to enter intersection at the same time.

/*Macros

 */

#define ISPING(p) ((p)[0]==WPINGGLOBAL || (p)[0]==WPINGBOT || (p)[0]==WPINGQUEUE)

#endif