Colony

#include "wl_error_group.h"

#include <wireless.h>

#include <wl_defs.h>

#include <stdio.h>

#include <string.h>

void wl_error_response_receive(int frame, int received);

void wl_error_handle_receive(char type, int source, unsigned char* packet,

                                                        int length);

PacketGroupHandler wl_error_handler =

                {WL_ERROR_GROUP, NULL,

                wl_error_response_receive, wl_error_handle_receive, NULL};

void wl_error_response_receive(int frame, int received)

{

        WL_DEBUG_PRINT("Response received.\r\n");

        if (!received)

        {

                WL_DEBUG_PRINT("FAILED.\r\n");

        }

}

/**

 * Register this packet group with the wireless library.

 * This function must be called before any other wl_error

 * function.

 **/

void wl_error_register(void)

{

        wl_register_packet_group(&wl_error_handler);

}

/**

 * Unregister this packet group with the wireless library.

 * This function must be called after wl_error_register.

 *

 * @see wl_error_register

 **/

void wl_error_unregister(void)

{

        wl_unregister_packet_group(&wl_error_handler);

}

/**

 * Handles receiving an error packet.

 *

 * @param type the packet type

 * @param source the 16-bit address of the packet's sender

 * @param packet the packet data

 * @param length the length in bytes of the packet

 **/

void wl_error_handle_receive(char type, int source, unsigned char* packet,

                                                        int length)

{

        switch (type)

        {

                case WL_ERROR_STRING_TYPE:

                        if (packet[length - 1] != 0)

                        {

                                WL_DEBUG_PRINT(

                                        "Error packet string should be null terminated.\r\n");

                                break;

                        }

                        WL_DEBUG_PRINT("Error packet received from robot ");

                        WL_DEBUG_PRINT_INT(source);

                        WL_DEBUG_PRINT(":\r\n");

                        WL_DEBUG_PRINT((char*)packet);

                        WL_DEBUG_PRINT("\r\n");

                        break;

                default:

                        WL_DEBUG_PRINT("Error packet of unknown type received.\r\n");

                        break;

        }

}

/**

 * Send an error message as a string.

 * 

 * @param str the error message to send

 **/

void wl_error_send_string(char* str)

{

        wl_send_global_packet(WL_ERROR_GROUP, WL_ERROR_STRING_TYPE,

                str, strlen(str) + 1, 1);

}