WebSVN – Code-Repo – Diff – /PIC Stuff/Cerebot_32MX7_LED_Cube/CUBE.c

 void Cube_Text_Init(char *string, char length, int R, int G, int B) {
     // Ensure that the length of the string does not exceed the storage buffer
     if (length > CUBE_STRING_MAX_LENGTH) length = CUBE_STRING_MAX_LENGTH;
+    Cube_Overlay_Clear();
     // Copy the passed data into the buffer
     int i;
     for (i = 0; i < length; i++)
         cube_data_ptr->string[i] = string[i];
     cube_data_ptr->string_length = length;
     if (c == CUBE_START_CHAR) {
         cube_data_ptr->frame_length = 0;
         cube_data_ptr->frame_index = 0;
         cube_data_ptr->frame_checksum = 0;
         cube_data_ptr->frame_command = 0;
+        cube_data_ptr->frame_escape = 0;
         cube_data_ptr->frame_state = READ_LENGTH_MSB;
-    } else {
+        return;
+    }
-        // If the input is the escape char, XOR the next char received
+    // If the input is the escape char, XOR the next char received
-        if (c == CUBE_ESCAPE_CHAR) {
+    if (c == CUBE_ESCAPE_CHAR) {
-            cube_data_ptr->frame_escape = 1;
+        cube_data_ptr->frame_escape = 1;
-            return;
+        return;
-        }
+    }
-        // XOR the input char if needed
+    // XOR the input char if needed
-        if (cube_data_ptr->frame_escape) {
+    if (cube_data_ptr->frame_escape) {
-            c ^= CUBE_ESCAPE_XOR;
+        c ^= CUBE_ESCAPE_XOR;
-            cube_data_ptr->frame_escape = 0;
+        cube_data_ptr->frame_escape = 0;
-        }
+    }
-        // Process data
+    // Process data
-        switch (cube_data_ptr->frame_state) {
+    switch (cube_data_ptr->frame_state) {
-            case IDLE:
+        case IDLE:
-                // Reflect the character back to the transmitter
+            // Reflect the character back to the transmitter
-                UART1_Write(&c, 1);
+            UART1_Write(&c, 1);
-                break;
+            break;
-            case READ_LENGTH_MSB: // Save MSB of length
+        case READ_LENGTH_MSB: // Save MSB of length
-                cube_data_ptr->frame_length |= (c << 8);
+            cube_data_ptr->frame_length |= (c << 8);
-                cube_data_ptr->frame_state = READ_LENGTH_LSB;
+            cube_data_ptr->frame_state = READ_LENGTH_LSB;
-                break;
+            break;
-            case READ_LENGTH_LSB: // Save LSB of length
+        case READ_LENGTH_LSB: // Save LSB of length
-                cube_data_ptr->frame_length |= c;
+            cube_data_ptr->frame_length |= c;
-                cube_data_ptr->frame_state = READ_COMMAND;
+            cube_data_ptr->frame_state = READ_COMMAND;
-                break;
+            break;
-            case READ_COMMAND: // Store the command byte
+        case READ_COMMAND: // Store the command byte
-                cube_data_ptr->frame_checksum += c;
+            cube_data_ptr->frame_checksum += c;
-                cube_data_ptr->frame_command = c;
+            cube_data_ptr->frame_command = c;
+            if (cube_data_ptr->frame_length == 1)
+                cube_data_ptr->frame_state = READ_CHECKSUM;
+            else
                 cube_data_ptr->frame_state = READ_DATA;
-                break;
+            break;
-            case READ_DATA: // Read the passed data into the buffer
+        case READ_DATA: // Read the passed data into the buffer
-                cube_data_ptr->frame_checksum += c;
+            cube_data_ptr->frame_checksum += c;
-                cube_data_ptr->frame_buffer[cube_data_ptr->frame_index] = c;
+            cube_data_ptr->frame_buffer[cube_data_ptr->frame_index] = c;
-                cube_data_ptr->frame_index++;
+            cube_data_ptr->frame_index++;
-                if (cube_data_ptr->frame_index == cube_data_ptr->frame_length - 1)
+            if (cube_data_ptr->frame_index == cube_data_ptr->frame_length - 1)
-                    cube_data_ptr->frame_state = READ_CHECKSUM;
+                cube_data_ptr->frame_state = READ_CHECKSUM;
-                break;
+            break;
-            case READ_CHECKSUM: // Process frame if checksum is valid
+        case READ_CHECKSUM: // Process frame if checksum is valid
-                cube_data_ptr->frame_checksum = 0xFF - cube_data_ptr->frame_checksum;
+            cube_data_ptr->frame_checksum = 0xFF - cube_data_ptr->frame_checksum;
-                if (cube_data_ptr->frame_checksum == c) {
+            if (cube_data_ptr->frame_checksum == c) {
-                    Cube_Data_In_Process_Frame();
+                Cube_Data_In_Process_Frame();
-                }
+            }
-                cube_data_ptr->frame_state = IDLE;
+            cube_data_ptr->frame_state = IDLE;
+            cube_data_ptr->frame_index = 0;
+            cube_data_ptr->frame_length = 0;
-                break;
+            break;
-            default:
+        default:
-                break;
+            break;
-        }
+    }
+}
 void Cube_Data_In_Process_Frame(void) {
+    // Here we process received frames depending on the command
     char *frame = cube_data_ptr->frame_buffer;
     switch (cube_data_ptr->frame_command) {
+        case CUBE_COMMAND_SET_BC:
+            TIMER5_Stop();
+            Delay_MS(1); // Need to wait for all SPI writes to complete
+            Cube_Write_DCS(frame[0]);
+            TIMER5_Start();
+            break;
+        case CUBE_COMMAND_CLEAR:
+            Cube_Clear();
+            break;
         case CUBE_COMMAND_SET_PIXEL:
             Cube_Set_Pixel(frame[0], frame[1], frame[2], frame[3], frame[4], frame[5]);
             break;
+        case CUBE_COMMAND_SET_LAYER:
+            Cube_Data_Direct_Write(frame[0], &frame[1]);
+            break;
+        case CUBE_COMMAND_START_TEXT:
+            Cube_Text_Init(&frame[3], cube_data_ptr->frame_length - 4, frame[0], frame[1], frame[2]);
+            TIMER4_Start();
+            break;
+        case CUBE_COMMAND_STOP_TEXT:
+            TIMER4_Stop();
+            Cube_Overlay_Clear();
+            break;
         default:
             break;
+    }
+}
+void Cube_Data_Direct_Write(char layer, char *buffer) {
+    int i;
+    for (i = 0; i < GCS_LAYER_SIZE; i++) {
+        cube_data_ptr->GCS[layer][i] = buffer[i];
+    }
+}

Subversion Repositories Code-Repo

(root)/PIC Stuff/Cerebot_32MX7_LED_Cube/CUBE.c @ 215 – Rev 213 → 215