4,17 → 4,23 |
|
static CONTROLLER_DATA *ctrl_data_p; |
|
void Controller_Init(CONTROLLER_DATA *data) { |
ctrl_data_p = data; |
void Controller_Init(CONTROLLER_DATA *data, |
void (*change_callback)(uint8_t controller, CTRL_BTN_STATUS values)) { |
|
if (data != NULL) |
ctrl_data_p = data; |
ctrl_data_p->change_callback = change_callback; |
|
// Variable initialization |
int i; |
int i, j; |
for (i = 0; i < CONTROLLER_MAX_COUNT; i++) { |
ctrl_data_p->connected_controllers[i] = 0x0; |
ctrl_data_p->led_status[i][0] = 0x0; |
ctrl_data_p->led_status[i][1] = 0x0; |
ctrl_data_p->btn_prev[i] = 0x0; |
ctrl_data_p->btn_last[i] = 0x0; |
ctrl_data_p->led_status[i].w[i] = 0x0; |
ctrl_data_p->btn_prev[i].w = 0x0; |
ctrl_data_p->btn_curr[i].w = 0x0; |
for (j = 0; j < 16; j++) { |
ctrl_data_p->led_status[i].w[j] = 0x0; |
} |
} |
|
ctrl_data_p->connected_count = 0x0; |
24,157 → 30,167 |
} |
|
void Controller_Poll_Connected(void) { |
uint8_t buffer[2] = {CONTROLLER_CMD_RESET}; |
uint8_t result, length, i; |
uint8_t buffer[2]; |
uint8_t result, i; |
uint8_t address = CONTROLLER_PREFIX_ADDRESS + CONTROLLER_START_ADDRESS; |
|
// Attempt to contact each controller to see if its connected |
for (i = 0; i < CONTROLLER_MAX_COUNT; i++) { |
// I2C1_Master_Send(address + i, buffer, 1); |
// do { |
// result = I2C1_Get_Status(); |
// } while (!result); |
// if (result == I2C1_SEND_OK) { |
// // If a controller is connected, save its address |
// ctrl_data_p->connected_controllers[ctrl_data_p->connected_count] |
// = address + i; |
// ctrl_data_p->connected_count++; |
// } |
I2C1_Master_Restart(address + i, CONTROLLER_CMD_READ, 1); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
if (result == I2C1_RECV_OK) { |
length = I2C1_Read_Buffer(buffer); |
uint8_t length = I2C1_Read_Buffer(buffer); |
// If a controller is connected, save its address |
ctrl_data_p->connected_controllers[ctrl_data_p->connected_count] |
= address + i; |
ctrl_data_p->connected_controllers[ctrl_data_p->connected_count] = address + i; |
ctrl_data_p->connected_count++; |
} |
|
// A small delay is needed between polls |
Delay_MS(1); |
} |
|
// Show the number of controllers connected |
if (ctrl_data_p->connected_count & 0x1) |
LED1_LAT = 1; |
if (ctrl_data_p->connected_count & 0x2) |
LED2_LAT = 1; |
if (ctrl_data_p->connected_count & 0x4) |
LED3_LAT = 1; |
if (ctrl_data_p->connected_count & 0x8) |
LED4_LAT = 1; |
} |
|
void Controller_Update(void) { |
/* |
uint8_t buffer[2]; |
uint8_t result, length; |
uint8_t ctrl_1_btn = 0, ctrl_2_btn = 0; |
uint8_t result, length, i, j; |
CTRL_BTN_STATUS btn_change; |
|
for (i = 0; i < ctrl_data_p->connected_count; i++) { |
// Store the last read values |
ctrl_data_p->btn_prev[i] = ctrl_data_p->btn_curr[i]; |
|
// Read button values from controllers |
I2C1_Master_Restart(CONTROLLER_1_ADDRESS, CONTROLLER_READ, 1); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
if (result == I2C1_RECV_OK) { |
// Indicate that controller 1 is connected |
LED1_LAT = 1; |
ctrl_data_p->ctrl_1_connected = 1; |
// Read in the button values for each controller |
I2C1_Master_Restart(ctrl_data_p->connected_controllers[i], CONTROLLER_CMD_READ, 1); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
// Save the read values |
length = I2C1_Read_Buffer(buffer); |
buffer[0] = ~buffer[0]; |
// Button change detected |
if (ctrl_data_p->ctrl_1_buttons_prev != buffer[0]) { |
// Check if a button has been pressed since startup |
if (!ctrl_data_p->ctrl_1_active) { |
ctrl_data_p->ctrl_1_active = 1; |
ctrl_data_p->btn_curr[i].w = buffer[0]; |
|
// Determine if a change was made between the current and previous values |
if (ctrl_data_p->btn_curr[i].w != ctrl_data_p->btn_prev[i].w) { |
// Determine if a button was pressed (unpressed->pressed) |
btn_change.w = ctrl_data_p->btn_prev[i].w ^ ctrl_data_p->btn_curr[i].w; |
btn_change.w &= ctrl_data_p->btn_curr[i].w; |
|
// If a button was pressed, call the saved callback |
if (btn_change.w) { |
if (ctrl_data_p->change_callback != NULL) { |
ctrl_data_p->change_callback(i, btn_change); |
} |
} |
// Figure out which button has changed |
ctrl_1_btn = ctrl_data_p->ctrl_1_buttons_prev ^ buffer[0]; |
// Save the button if it went from unpressed -> pressed |
ctrl_1_btn &= buffer[0]; |
} |
ctrl_data_p->ctrl_1_buttons_prev = buffer[0]; |
} else { |
LED1_LAT = 0; |
ctrl_data_p->ctrl_1_connected = 0; |
ctrl_data_p->ctrl_1_active = 0; |
} |
} |
|
I2C1_Master_Restart(CONTROLLER_2_ADDRESS, CONTROLLER_READ, 1); |
void Controller_Set_Left_Leds(uint8_t controller, uint8_t value) { |
uint8_t result, i; |
uint8_t buffer[18]; |
|
for (i = 0; i < 4; i++) { |
if (value & (0x01 << i)) |
ctrl_data_p->led_status[controller].w[i+12] = CONTROLLER_BRIGHTNESS_HIGH; |
else |
ctrl_data_p->led_status[controller].w[i+12] = 0x00; |
} |
|
// Write the LED value to the controller |
buffer[0] = CONTROLLER_CMD_WRITE; |
for (i = 0; i < 16; i++) |
buffer[i+1] = ctrl_data_p->led_status[controller].w[i]; |
I2C1_Master_Send(ctrl_data_p->connected_controllers[controller], buffer, 17); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
if (result == I2C1_RECV_OK) { |
// Indicate that controller 2 is connected |
LED2_LAT = 1; |
ctrl_data_p->ctrl_2_connected = 1; |
length = I2C1_Read_Buffer(buffer); |
buffer[0] = ~buffer[0]; |
// Button change detected |
if (ctrl_data_p->ctrl_2_buttons_prev != buffer[0]) { |
// Check if a button has been pressed since startup |
if (!ctrl_data_p->ctrl_2_active) { |
ctrl_data_p->ctrl_2_active = 1; |
} |
// Figure out which button has changed |
ctrl_2_btn = ctrl_data_p->ctrl_2_buttons_prev ^ buffer[0]; |
// Save the button if it went from unpressed -> pressed |
ctrl_2_btn &= buffer[0]; |
} |
ctrl_data_p->ctrl_2_buttons_prev = buffer[0]; |
} else { |
LED2_LAT = 0; |
ctrl_data_p->ctrl_2_connected = 0; |
ctrl_data_p->ctrl_2_active = 0; |
} |
|
// Write LED values to controllers |
if (ctrl_data_p->ctrl_1_connected) { |
buffer[0] = CONTROLLER_WRITE; |
buffer[1] = ctrl_data_p->ctrl_1_leds; |
I2C1_Master_Send(CONTROLLER_1_ADDRESS, buffer, 2); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
} |
Delay_MS(1); |
} |
|
if (ctrl_data_p->ctrl_2_connected) { |
buffer[0] = CONTROLLER_WRITE; |
buffer[1] = ctrl_data_p->ctrl_2_leds; |
I2C1_Master_Send(CONTROLLER_2_ADDRESS, buffer, 2); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
void Controller_Set_Middle_Leds(uint8_t controller, uint8_t value) { |
uint8_t result, i; |
uint8_t buffer[18]; |
|
for (i = 0; i < 8; i++) { |
if (value & (0x01 << i)) |
ctrl_data_p->led_status[controller].w[i] = CONTROLLER_BRIGHTNESS_HIGH; |
else |
ctrl_data_p->led_status[controller].w[i] = 0x00; |
} |
|
// If board is in an idle state and a controller is connected, switch modes |
if (Get_Board_State() == BOARD_MODE_IDLE) { |
// If both controllers are active, go into game TRON mode |
if (ctrl_data_p->ctrl_1_active && ctrl_data_p->ctrl_2_active) { |
Reset_Board(BOARD_MODE_TRON); |
} |
// Otherwise if only one controller is active, go into game SNAKE mode |
if (ctrl_data_p->ctrl_1_active || ctrl_data_p->ctrl_2_active) { |
Reset_Board(BOARD_MODE_SNAKE); |
} |
// Write the LED value to the controller |
buffer[0] = CONTROLLER_CMD_WRITE; |
for (i = 0; i < 16; i++) |
buffer[i+1] = ctrl_data_p->led_status[controller].w[i]; |
I2C1_Master_Send(ctrl_data_p->connected_controllers[controller], buffer, 17); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
|
Delay_MS(1); |
} |
|
void Controller_Set_Right_Leds(uint8_t controller, uint8_t value) { |
uint8_t result, i; |
uint8_t buffer[18]; |
|
for (i = 0; i < 4; i++) { |
if (value & (0x01 << i)) |
ctrl_data_p->led_status[controller].w[i+8] = CONTROLLER_BRIGHTNESS_HIGH; |
else |
ctrl_data_p->led_status[controller].w[i+8] = 0x00; |
} |
if (Get_Board_State() == BOARD_MODE_SNAKE) { |
// If both controllers are active, go into game TRON mode |
if (ctrl_data_p->ctrl_1_active && ctrl_data_p->ctrl_2_active) { |
Reset_Board(BOARD_MODE_TRON); |
} |
} |
|
// Call the callback function if any buttons have changed |
if (ctrl_data_p->btn_change_callback != NULL) { |
if (ctrl_1_btn || ctrl_2_btn) { |
(*ctrl_data_p->btn_change_callback)(ctrl_1_btn, ctrl_2_btn); |
} |
} |
*/ |
// Write the LED value to the controller |
buffer[0] = CONTROLLER_CMD_WRITE; |
for (i = 0; i < 16; i++) |
buffer[i+1] = ctrl_data_p->led_status[controller].w[i]; |
I2C1_Master_Send(ctrl_data_p->connected_controllers[controller], buffer, 17); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
|
Delay_MS(1); |
} |
|
void Controller_Set_Leds(uint8_t controller, uint16_t value) { |
// ctrl_data_p->ctrl_1_leds = ctrl_1; |
// ctrl_data_p->ctrl_2_leds = ctrl_2; |
uint8_t Controller_Get_Connected(void) { |
return ctrl_data_p->connected_count; |
} |
|
uint8_t Controller_Query(uint8_t controller) { |
// // Returns the active status of attached controllers |
// if (ctrl_data_p->ctrl_1_active && ctrl_data_p->ctrl_2_active) |
// return 0x3; |
// else if (ctrl_data_p->ctrl_1_active) |
// return 0x1; |
// else if (ctrl_data_p->ctrl_2_active) |
// return 0x2; |
// return 0; |
void Controller_Set_Active(uint8_t controller) { |
uint8_t buffer[2]; |
uint8_t result; |
|
buffer[0] = CONTROLLER_CMD_ACTIVE; |
I2C1_Master_Send(ctrl_data_p->connected_controllers[controller], buffer, 1); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
|
Delay_MS(1); |
} |
|
void Controller_Set_Idle(uint8_t controller) { |
uint8_t buffer[2]; |
uint8_t result; |
|
buffer[0] = CONTROLLER_CMD_RESET; |
I2C1_Master_Send(ctrl_data_p->connected_controllers[controller], buffer, 1); |
do { |
result = I2C1_Get_Status(); |
} while (!result); |
|
Delay_MS(1); |
} |