Subversion Repositories Code-Repo

Compare Revisions

Ignore whitespace Rev 237 → Rev 238

/PIC Stuff/Cerebot_32MX7_LED_Cube/CONTROLLERS.c
0,0 → 1,139
#include "defines.h"
#include "CONTROLLERS.h"
#include "I2C1.h"
 
static CONTROLLER_DATA *ctrl_data_p;
static BOARD_STATE *board_state_p;
 
void Controller_Init(CONTROLLER_DATA *data, BOARD_STATE *state,
void (*btn_change_callback)(uint8_t, uint8_t)) {
ctrl_data_p = data;
board_state_p = state;
 
ctrl_data_p->btn_change_callback = btn_change_callback;
ctrl_data_p->ctrl_1_connected = 0;
ctrl_data_p->ctrl_1_buttons_prev = CONTROLLER_BTN_DEFAULT;
ctrl_data_p->ctrl_1_leds = CONTROLLER_LED_DEFAULT;
ctrl_data_p->ctrl_1_active = 0;
 
ctrl_data_p->ctrl_2_connected = 0;
ctrl_data_p->ctrl_2_buttons_prev = CONTROLLER_BTN_DEFAULT;
ctrl_data_p->ctrl_2_leds = CONTROLLER_LED_DEFAULT;
ctrl_data_p->ctrl_2_active = 0;
}
 
void Controller_Update(void) {
uint8_t buffer[2];
uint8_t result, length;
uint8_t ctrl_1_btn = 0, ctrl_2_btn = 0;
 
// 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;
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;
}
// 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);
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);
}
 
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);
}
 
// If board is in an idle state and a controller is connected, switch modes
if (board_state_p->cube_mode == 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) {
board_state_p->cube_mode = BOARD_MODE_TRON;
Reset_Board();
}
// 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) {
board_state_p->cube_mode = BOARD_MODE_SNAKE;
Reset_Board();
}
}
if (board_state_p->cube_mode == 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) {
board_state_p->cube_mode = BOARD_MODE_TRON;
Reset_Board();
}
}
 
// 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);
}
}
}
 
void Controller_Set_Leds(uint8_t ctrl_1, uint8_t ctrl_2) {
ctrl_data_p->ctrl_1_leds = ctrl_1;
ctrl_data_p->ctrl_2_leds = ctrl_2;
}