Subversion Repositories Code-Repo

Compare Revisions

Ignore whitespace Rev 275 → Rev 276

/PIC Stuff/Cerebot_32MX7_LED_Cube/CONTROLLERS.c
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);
}