| 238 |
Kevin |
1 |
#include "defines.h"
|
|
|
2 |
#include "CONTROLLERS.h"
|
|
|
3 |
#include "I2C1.h"
|
|
|
4 |
|
|
|
5 |
static CONTROLLER_DATA *ctrl_data_p;
|
|
|
6 |
static BOARD_STATE *board_state_p;
|
|
|
7 |
|
|
|
8 |
void Controller_Init(CONTROLLER_DATA *data, BOARD_STATE *state,
|
|
|
9 |
void (*btn_change_callback)(uint8_t, uint8_t)) {
|
|
|
10 |
ctrl_data_p = data;
|
|
|
11 |
board_state_p = state;
|
|
|
12 |
|
|
|
13 |
ctrl_data_p->btn_change_callback = btn_change_callback;
|
|
|
14 |
|
|
|
15 |
ctrl_data_p->ctrl_1_connected = 0;
|
|
|
16 |
ctrl_data_p->ctrl_1_buttons_prev = CONTROLLER_BTN_DEFAULT;
|
|
|
17 |
ctrl_data_p->ctrl_1_leds = CONTROLLER_LED_DEFAULT;
|
|
|
18 |
ctrl_data_p->ctrl_1_active = 0;
|
|
|
19 |
|
|
|
20 |
ctrl_data_p->ctrl_2_connected = 0;
|
|
|
21 |
ctrl_data_p->ctrl_2_buttons_prev = CONTROLLER_BTN_DEFAULT;
|
|
|
22 |
ctrl_data_p->ctrl_2_leds = CONTROLLER_LED_DEFAULT;
|
|
|
23 |
ctrl_data_p->ctrl_2_active = 0;
|
|
|
24 |
}
|
|
|
25 |
|
|
|
26 |
void Controller_Update(void) {
|
|
|
27 |
uint8_t buffer[2];
|
|
|
28 |
uint8_t result, length;
|
|
|
29 |
uint8_t ctrl_1_btn = 0, ctrl_2_btn = 0;
|
|
|
30 |
|
|
|
31 |
// Read button values from controllers
|
|
|
32 |
I2C1_Master_Restart(CONTROLLER_1_ADDRESS, CONTROLLER_READ, 1);
|
|
|
33 |
do {
|
|
|
34 |
result = I2C1_Get_Status();
|
|
|
35 |
} while (!result);
|
|
|
36 |
if (result == I2C1_RECV_OK) {
|
|
|
37 |
// Indicate that controller 1 is connected
|
|
|
38 |
LED1_LAT = 1;
|
|
|
39 |
ctrl_data_p->ctrl_1_connected = 1;
|
|
|
40 |
length = I2C1_Read_Buffer(buffer);
|
|
|
41 |
buffer[0] = ~buffer[0];
|
|
|
42 |
// Button change detected
|
|
|
43 |
if (ctrl_data_p->ctrl_1_buttons_prev != buffer[0]) {
|
|
|
44 |
// Check if a button has been pressed since startup
|
|
|
45 |
if (!ctrl_data_p->ctrl_1_active) {
|
|
|
46 |
ctrl_data_p->ctrl_1_active = 1;
|
|
|
47 |
}
|
|
|
48 |
// Figure out which button has changed
|
|
|
49 |
ctrl_1_btn = ctrl_data_p->ctrl_1_buttons_prev ^ buffer[0];
|
|
|
50 |
// Save the button if it went from unpressed -> pressed
|
|
|
51 |
ctrl_1_btn &= buffer[0];
|
|
|
52 |
}
|
|
|
53 |
ctrl_data_p->ctrl_1_buttons_prev = buffer[0];
|
|
|
54 |
} else {
|
|
|
55 |
LED1_LAT = 0;
|
|
|
56 |
ctrl_data_p->ctrl_1_connected = 0;
|
|
|
57 |
ctrl_data_p->ctrl_1_active = 0;
|
|
|
58 |
}
|
|
|
59 |
|
|
|
60 |
I2C1_Master_Restart(CONTROLLER_2_ADDRESS, CONTROLLER_READ, 1);
|
|
|
61 |
do {
|
|
|
62 |
result = I2C1_Get_Status();
|
|
|
63 |
} while (!result);
|
|
|
64 |
if (result == I2C1_RECV_OK) {
|
|
|
65 |
// Indicate that controller 2 is connected
|
|
|
66 |
LED2_LAT = 1;
|
|
|
67 |
ctrl_data_p->ctrl_2_connected = 1;
|
|
|
68 |
length = I2C1_Read_Buffer(buffer);
|
|
|
69 |
buffer[0] = ~buffer[0];
|
|
|
70 |
// Button change detected
|
|
|
71 |
if (ctrl_data_p->ctrl_2_buttons_prev != buffer[0]) {
|
|
|
72 |
// Check if a button has been pressed since startup
|
|
|
73 |
if (!ctrl_data_p->ctrl_2_active) {
|
|
|
74 |
ctrl_data_p->ctrl_2_active = 1;
|
|
|
75 |
}
|
|
|
76 |
// Figure out which button has changed
|
|
|
77 |
ctrl_2_btn = ctrl_data_p->ctrl_2_buttons_prev ^ buffer[0];
|
|
|
78 |
// Save the button if it went from unpressed -> pressed
|
|
|
79 |
ctrl_2_btn &= buffer[0];
|
|
|
80 |
}
|
|
|
81 |
ctrl_data_p->ctrl_2_buttons_prev = buffer[0];
|
|
|
82 |
} else {
|
|
|
83 |
LED2_LAT = 0;
|
|
|
84 |
ctrl_data_p->ctrl_2_connected = 0;
|
|
|
85 |
ctrl_data_p->ctrl_2_active = 0;
|
|
|
86 |
}
|
|
|
87 |
|
|
|
88 |
// Write LED values to controllers
|
|
|
89 |
if (ctrl_data_p->ctrl_1_connected) {
|
|
|
90 |
buffer[0] = CONTROLLER_WRITE;
|
|
|
91 |
buffer[1] = ctrl_data_p->ctrl_1_leds;
|
|
|
92 |
I2C1_Master_Send(CONTROLLER_1_ADDRESS, buffer, 2);
|
|
|
93 |
do {
|
|
|
94 |
result = I2C1_Get_Status();
|
|
|
95 |
} while (!result);
|
|
|
96 |
}
|
|
|
97 |
|
|
|
98 |
if (ctrl_data_p->ctrl_2_connected) {
|
|
|
99 |
buffer[0] = CONTROLLER_WRITE;
|
|
|
100 |
buffer[1] = ctrl_data_p->ctrl_2_leds;
|
|
|
101 |
I2C1_Master_Send(CONTROLLER_2_ADDRESS, buffer, 2);
|
|
|
102 |
do {
|
|
|
103 |
result = I2C1_Get_Status();
|
|
|
104 |
} while (!result);
|
|
|
105 |
}
|
|
|
106 |
|
|
|
107 |
// If board is in an idle state and a controller is connected, switch modes
|
|
|
108 |
if (board_state_p->cube_mode == BOARD_MODE_IDLE) {
|
|
|
109 |
// If both controllers are active, go into game TRON mode
|
|
|
110 |
if (ctrl_data_p->ctrl_1_active && ctrl_data_p->ctrl_2_active) {
|
|
|
111 |
board_state_p->cube_mode = BOARD_MODE_TRON;
|
|
|
112 |
Reset_Board();
|
|
|
113 |
}
|
|
|
114 |
// Otherwise if only one controller is active, go into game SNAKE mode
|
|
|
115 |
if (ctrl_data_p->ctrl_1_active || ctrl_data_p->ctrl_2_active) {
|
|
|
116 |
board_state_p->cube_mode = BOARD_MODE_SNAKE;
|
|
|
117 |
Reset_Board();
|
|
|
118 |
}
|
|
|
119 |
}
|
|
|
120 |
if (board_state_p->cube_mode == BOARD_MODE_SNAKE) {
|
|
|
121 |
// If both controllers are active, go into game TRON mode
|
|
|
122 |
if (ctrl_data_p->ctrl_1_active && ctrl_data_p->ctrl_2_active) {
|
|
|
123 |
board_state_p->cube_mode = BOARD_MODE_TRON;
|
|
|
124 |
Reset_Board();
|
|
|
125 |
}
|
|
|
126 |
}
|
|
|
127 |
|
|
|
128 |
// Call the callback function if any buttons have changed
|
|
|
129 |
if (ctrl_data_p->btn_change_callback != NULL) {
|
|
|
130 |
if (ctrl_1_btn || ctrl_2_btn) {
|
|
|
131 |
(*ctrl_data_p->btn_change_callback)(ctrl_1_btn, ctrl_2_btn);
|
|
|
132 |
}
|
|
|
133 |
}
|
|
|
134 |
}
|
|
|
135 |
|
|
|
136 |
void Controller_Set_Leds(uint8_t ctrl_1, uint8_t ctrl_2) {
|
|
|
137 |
ctrl_data_p->ctrl_1_leds = ctrl_1;
|
|
|
138 |
ctrl_data_p->ctrl_2_leds = ctrl_2;
|
|
|
139 |
}
|