root / trunk / code / projects / libwireless / lib / wl_basic.c @ 1425
History | View | Annotate | Download (3.36 KB)
1 |
/**
|
---|---|
2 |
* @file wl_basic.c
|
3 |
* @brief High Level Wireless Packet Sending-Receiving Functions
|
4 |
*
|
5 |
* Abstracted wireless functionality for sending and receiving packets
|
6 |
*
|
7 |
* @author Christopher Mar, Colony Project, CMU Robotics Club
|
8 |
**/
|
9 |
|
10 |
#include <wireless.h> |
11 |
#include "wl_basic.h" |
12 |
|
13 |
/**
|
14 |
* Wrapper for wl_init().
|
15 |
* Initializes wireless and registers a packet handler function for Basic Group.
|
16 |
*
|
17 |
* @param handle_receive function pointer to handler function for Basic Group
|
18 |
* @return 0 on success, -1 on error
|
19 |
**/
|
20 |
int wl_basic_init( void(*handle_receive) (char type, int source, |
21 |
unsigned char* packet, int length) ) { |
22 |
int returnme = wl_init();
|
23 |
wl_basic_register_handler(handle_receive); |
24 |
current_packet.new_flag = 0;
|
25 |
return returnme;
|
26 |
} |
27 |
|
28 |
/**
|
29 |
* Wrapper for wl_init().
|
30 |
* Initializes wireless and registers the default packet handler for Basig Group.
|
31 |
*
|
32 |
**/
|
33 |
int wl_basic_init_default( ) {
|
34 |
return wl_basic_init(&wl_basic_packet_receive_handler);
|
35 |
} |
36 |
|
37 |
/**
|
38 |
* Internal function to register a packet group handler for Basic Group.
|
39 |
*
|
40 |
* @param handle_receive function pointer to handler function for Basic Group
|
41 |
**/
|
42 |
void wl_basic_register_handler( void (*handle_receive) (char type, int source, |
43 |
unsigned char* packet, int length)) { |
44 |
wl_basic_group_handler.groupCode = WL_BASIC_GROUP; |
45 |
wl_basic_group_handler.timeout_handler = 0;
|
46 |
wl_basic_group_handler.handle_response = 0;
|
47 |
wl_basic_group_handler.handle_receive = handle_receive; |
48 |
wl_basic_group_handler.unregister = 0;
|
49 |
|
50 |
wl_register_packet_group(&wl_basic_group_handler); |
51 |
} |
52 |
|
53 |
/**
|
54 |
* Send a packet to a single robot in Basic Group.
|
55 |
*
|
56 |
* @param type Packet type
|
57 |
* @param data Packet buffer, data you want to send
|
58 |
* @param len Length of the data buffer in bytes
|
59 |
* @param dest Robot ID of the destination robot
|
60 |
**/
|
61 |
void wl_basic_send_robot_packet( char type, char* data, int len, int dest ) { |
62 |
wl_send_robot_to_robot_global_packet(WL_BASIC_GROUP, type, data, len, dest, 0);
|
63 |
} |
64 |
|
65 |
/**
|
66 |
* Send a packet to all robots in Basic Group.
|
67 |
*
|
68 |
* @param type Packet type
|
69 |
* @param data Packet buffer, data you want to send
|
70 |
* @param len Length of the data buffer in bytes
|
71 |
**/
|
72 |
void wl_basic_send_global_packet( char type, char* data, int len ) { |
73 |
wl_send_global_packet(WL_BASIC_GROUP, type, data, len, 0);
|
74 |
} |
75 |
|
76 |
/**
|
77 |
* Default packet handler used if none is specified on init.
|
78 |
* This should not be called directly by any user program.
|
79 |
*
|
80 |
* @param type Packet type
|
81 |
* @param source the robot ID of the sending robot
|
82 |
* @param packet Packet buffer, data you received
|
83 |
* @param length Length of the data buffer in bytes
|
84 |
**/
|
85 |
void wl_basic_packet_receive_handler( char type, int source, unsigned char* packet, int length ) { |
86 |
current_packet.new_flag = 1;
|
87 |
current_packet.type = type; |
88 |
current_packet.source = source; |
89 |
current_packet.data = packet; |
90 |
current_packet.length = length; |
91 |
} |
92 |
|
93 |
/**
|
94 |
* Wrapper for wl_do() for use with the Basic Wireless group.
|
95 |
* Can only be called if wl_basic_init_default and your packets
|
96 |
* are handled with the default packet handler.
|
97 |
* To access packet information, use PacketInfo current_packet.
|
98 |
*
|
99 |
* @return pointer to the data of the packet just received, 0 if no new packet
|
100 |
**/
|
101 |
unsigned char* wl_basic_do_default( void ) { |
102 |
wl_do(); |
103 |
if (current_packet.new_flag == 1) { |
104 |
current_packet.new_flag = 0;
|
105 |
return current_packet.data;
|
106 |
} |
107 |
return 0; |
108 |
} |
109 |
|