Diff: t7utils.cpp

Revision:

3:92dae9083c83

Child:

4:682d96ff6d79

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/t7utils.cpp	Tue Jun 07 12:23:28 2011 +0000
@@ -0,0 +1,580 @@
+/*******************************************************************************
+
+t7utils.cpp
+(c) 2011 by Sophie Dexter
+portions (c) Tomi Liljemark (firstname.surname@gmail.com)
+
+This C++ module provides functions for communicating simple messages to and from
+the T7 ECU
+
+********************************************************************************
+
+WARNING: Use at your own risk, sadly this software comes with no guarantees.
+This software is provided 'free' and in good faith, but the author does not
+accept liability for any damage arising from its use.
+
+*******************************************************************************/
+
+#include "t7utils.h"
+
+
+//
+// t7_initialise
+//
+// sends an initialisation message to the T7 ECU
+// but doesn't displays anything.
+//
+// inputs:    none
+// return:    bool TRUE if there was a message, FALSE if no message.
+//
+
+
+bool t7_initialise() {
+    // send a can message to the T7 requesting that it initialises CAN communication with Just4Trionic
+    char T7TxMsg[] = T7INITMSG;
+    if (!can_send_timeout (T7CMNDID, T7TxMsg, 8, T7MESSAGETIMEOUT))
+        return FALSE;
+    // wait for the T7 to reply
+    char T7RxMsg[8];
+    // if a message is not received, has the wrong id
+    if (!can_wait_timeout(T7RESPID, T7RxMsg, 8, T7MESSAGETIMEOUT))
+        return FALSE;
+    /* DEBUG info...
+        for (int i = 0; i < 8; i++ ) printf("0x%02X ", T7RxMsg[i] );
+        printf(" init\r\n");
+    */
+    return TRUE;
+}
+
+//
+// t7_authenticate
+//
+// sends an authentication message to the T7 ECU
+// but doesn't displays anything.
+//
+// inputs:    none
+// return:    bool TRUE if there was a message, FALSE if no message.
+//
+
+bool t7_authenticate() {
+    uint16_t seed, key;
+//    uint16_t i;
+    char T7TxAck[] = T7ACK_MSG;
+    char T7TxMsg[] = T7SEC_MSG;
+    char T7TxKey[] = T7KEY_MSG;
+    char T7RxMsg[8];
+    // Send "Request Seed" to Trionic7
+    if (!can_send_timeout (T7SEC_ID, T7TxMsg, 8, T7MESSAGETIMEOUT))
+        return FALSE;
+    // wait for the T7 to reply
+    // Read "Seed"
+    // if a message is not received id return false
+    if (!can_wait_timeout(T7SEC_RX, T7RxMsg, 8, T7MESSAGETIMEOUT))
+        return FALSE;
+    /* DEBUG info...
+        for (i = 0; i < 8; i++ ) printf("0x%02X ", T7RxMsg[i] );
+        printf(" seed\r\n");
+    */
+    // Send Ack
+    T7TxAck[3] = T7RxMsg[0] & 0xBF;
+    if (!can_send_timeout (T7ACK_ID, T7TxAck, 8, T7MESSAGETIMEOUT))
+        return FALSE;
+    // Send "Key", try two different methods of calculating the key
+    seed = T7RxMsg[5] << 8 | T7RxMsg[6];
+    for (int method = 0; method < 2; method++ ) {
+        key = seed << 2;
+        key &= 0xFFFF;
+        key ^= ( method ? 0x4081 : 0x8142 );
+        key -= ( method ? 0x1F6F : 0x2356 );
+        key &= 0xFFFF;
+        T7TxKey[5] = ( key >> 8 ) & 0xFF;
+        T7TxKey[6] = key & 0xFF;
+        if (!can_send_timeout (T7SEC_ID, T7TxKey, 8, T7MESSAGETIMEOUT))
+            return FALSE;
+        // Wait for response
+        // if a message is not received id return false
+        if (!can_wait_timeout(T7SEC_RX, T7RxMsg, 8, T7MESSAGETIMEOUT))
+            return FALSE;
+        /* DEBUG info...
+                for (i = 0; i < 8; i++ ) printf("0x%02X ", T7RxMsg[i] );
+                printf(" key %d 0x%02X 0x%02X\r\n", method, T7RxMsg[3], T7RxMsg[5]);
+        */
+        // Send Ack
+        T7TxAck[3] = T7RxMsg[0] & 0xBF;
+        if (!can_send_timeout (T7ACK_ID, T7TxAck, 8, T7MESSAGETIMEOUT)) {
+            /* DEBUG info...
+                        printf("Key ACK message timeout\r\n");
+            */
+            return FALSE;
+        }
+        if ( T7RxMsg[3] == 0x67 && T7RxMsg[5] == 0x34 ) {
+            /* DEBUG info...
+                        printf("Key %d Accepted\r\n", method);
+            */
+            return TRUE;
+        } else {
+            /* DEBUG info...
+                        printf("Key %d Failed\r\n", method);
+            */
+        }
+    }
+    return FALSE;
+}
+//
+// t7_dump
+//
+// dumps the T7 BIN File
+// but doesn't displays anything.
+//
+// inputs:    none
+// return:    bool TRUE if there was a message, FALSE if no message.
+//
+
+bool t7_dump() {
+    uint32_t received;
+    uint8_t byte_count, retries, i;
+    char T7_dump_jumpa[] = T7DMPJP1A;
+    char T7_dump_jumpb[] = T7DMPJP1B;
+    char T7_dump_ack[] = T7DMP_ACK;
+    char T7_dump_data[] = T7DMPDATA;
+    char T7_dump_end[] = T7DMP_END;
+    char T7RxMsg[8];
+
+    printf("Creating FLASH dump file...\r\n");
+    FILE *fp = fopen("/local/original.bin", "w");    // Open "original.bin" on the local file system for writing
+    if (!fp) {
+        perror ("The following error occured");
+        return TERM_ERR;
+    }
+
+    timer.reset();
+    timer.start();
+
+    received = 0;
+    printf("       %% complete.\r");
+    while (received < T7FLASHSIZE) {
+//        T7_dump_jumpa[7] = ((T7FLASHSIZE - received) < 0xEF) ? (T7FLASHSIZE - received) : 0xEF;
+        T7_dump_jumpb[2] = (received >> 16) & 0xFF;
+        T7_dump_jumpb[3] = (received >> 8) & 0xFF;
+        T7_dump_jumpb[4] = received & 0xFF;
+        // Send read address and length to Trionic
+        if (!can_send_timeout (T7SEC_ID, T7_dump_jumpa, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        if (!can_send_timeout (T7SEC_ID, T7_dump_jumpb, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        // Wait for a response
+        if (!can_wait_timeout(T7SEC_RX, T7RxMsg, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        /* DEBUG info...
+            for (i = 0; i < 8; i++ ) printf("0x%02X ", T7RxMsg[i] );
+            printf(" seed\r\n");
+        */
+        // Send Ack
+        T7_dump_ack[3] = T7RxMsg[0] & 0xBF;
+        if (!can_send_timeout (T7ACK_ID, T7_dump_ack, 8, T7MESSAGETIMEOUT)) {
+            printf("ERROR Asking1: %5.1f %% done\r\n", 100*(float)received/(float)T7FLASHSIZE);
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        if ((T7RxMsg[3] != 0x6C) ||(T7RxMsg[4] != 0xF0)) {
+            printf("ERROR Asking2: %5.1f %% done\r\n", 100*(float)received/(float)T7FLASHSIZE);
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        // Ask T7 ECU to start sending data
+        for (retries = 0 ; retries <10 ; retries++ ) {
+            if (!can_send_timeout (T7SEC_ID, T7_dump_data, 8, T7MESSAGETIMEOUT)) {
+                printf("err t7utils line: %d\r\n", __LINE__ );
+                fclose(fp);
+                return FALSE;
+            }
+            // Read mesages from the T7 ECU
+            byte_count = 0;
+            T7RxMsg[0] = 0x00;
+            while (T7RxMsg[0] != 0x80 && T7RxMsg[0] != 0xC0) {
+                if (!can_wait_timeout(T7SEC_RX, T7RxMsg, 8, T7MESSAGETIMEOUT))
+                    break;
+                // Need to process the received data here!
+                // Send Ack
+                T7_dump_ack[3] = T7RxMsg[0] & 0xBF;
+                if (!can_send_timeout (T7ACK_ID, T7_dump_ack, 8, T7MESSAGETIMEOUT)) {
+                    printf("ERROR processing: %5.1f %% done\r\n", 100*(float)received/(float)T7FLASHSIZE);
+                    printf("err t7utils line: %d\r\n", __LINE__ );
+                    fclose(fp);
+                    return FALSE;
+                }
+//                /* DEBUG info...
+//                for (i = 0; i < 8; i++ ) printf("0x%02X ", T7RxMsg[i] );
+//                for (i = 2; i < 8; i++ ) printf("%c ", T7RxMsg[i] );
+//                printf(" data\r\n");
+                for (i = 2; i < 8; i++ )
+                    file_buffer[byte_count++] = (T7RxMsg[i]);
+//                */
+            }
+            // Success if these conditions met
+            if (T7RxMsg[0] == 0x80 || T7RxMsg[0] == 0xC0)
+                break;
+//            printf("retries: %d\r\n", retries);
+        }
+        if (retries > 9) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            printf("Retries: %d, Done: %5.2f %%\r\n", retries, 100*(float)received/(float)T7FLASHSIZE );
+            fclose(fp);
+            return FALSE;
+        }
+//        received += 0xEF;
+        received += 0x80;
+//        printf("Retries: %d, Done: %5.2f %%\r\n", retries, 100*(float)received/(float)T7FLASHSIZE );
+        printf("%6.2f\r", 100*(float)received/(float)T7FLASHSIZE );
+        fwrite((file_buffer + 3), 1, 0x80, fp);
+        if (ferror (fp)) {
+            fclose (fp);
+            printf ("Error writing to the FLASH BIN file.\r\n");
+            return TERM_ERR;
+        }
+    }
+    printf("\n");
+    // Send Message to T7 ECU to say that we have finished
+    if (!can_send_timeout (T7SEC_ID, T7_dump_end, 8, T7MESSAGETIMEOUT)) {
+        fclose(fp);
+        return FALSE;
+    }
+    // Wait for response
+    if (!can_wait_timeout(T7SEC_RX, T7RxMsg, 8, T7MESSAGETIMEOUT)) {
+        fclose(fp);
+        return FALSE;
+    }
+// Send Ack
+    T7_dump_ack[3] = T7RxMsg[0] & 0xBF;
+    if (!can_send_timeout (T7ACK_ID, T7_dump_ack, 8, T7MESSAGETIMEOUT)) {
+        printf("ERROR closing1: %5.1f %% done\r\n", 100*(float)received/(float)T7FLASHSIZE);
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if (T7RxMsg[3] != 0xC2) {
+        printf("ERROR closing2: %5.1f %% done\r\n", 100*(float)received/(float)T7FLASHSIZE);
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    timer.stop();
+    printf("SUCCESS! Getting the FLASH dump took %#.1f seconds.\r\n",timer.read());
+    fclose(fp);
+    return TRUE;
+}
+
+bool t7_erase() {
+    char T7_erase_msga[]   = { 0x40, 0xA1, 0x02, 0x31, 0x52, 0x00, 0x00, 0x00 };
+    char T7_erase_msgb[]   = { 0x40, 0xA1, 0x02, 0x31, 0x53, 0x00, 0x00, 0x00 };
+    char T7_erase_confirm[]   = { 0x40, 0xA1, 0x01, 0x3E, 0x00, 0x00, 0x00, 0x00 };
+    char T7_erase_ack[]     = { 0x40, 0xA1, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00 };
+    char data[8];
+    int i;
+
+    printf("Erasing T7 ECU FLASH...\r\n");
+
+    data[3] = 0;
+    i = 0;
+    while ( data[3] != 0x71 && i < 10) {
+        // Send "Request to ERASE" to Trionic
+        if (!can_send_timeout (T7SEC_ID, T7_erase_msga, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            return FALSE;
+        }
+        if (!can_wait_timeout(T7SEC_RX, data, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            return FALSE;
+        }
+        T7_erase_ack[3] = data[0] & 0xBF;
+        if (!can_send_timeout (T7ACK_ID, T7_erase_ack, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            return FALSE;
+        }
+        wait_ms(100);
+        i++;
+        printf(".");
+    }
+    printf("\r\n");
+    // Check to see if erase operation lasted longer than 1 sec...
+    if (i >=10) {
+        printf("Second Message took too long'\r\n");
+        return FALSE;
+    }
+    data[3] = 0;
+    i = 0;
+    while ( data[3] != 0x71 && i < 200) {
+        // Send "Request to ERASE" to Trionic
+        if (!can_send_timeout (T7SEC_ID, T7_erase_msgb, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            return FALSE;
+        }
+        if (!can_wait_timeout(T7SEC_RX, data, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            return FALSE;
+        }
+        T7_erase_ack[3] = data[0] & 0xBF;
+        if (!can_send_timeout (T7ACK_ID, T7_erase_ack, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            return FALSE;
+        }
+        wait_ms(100);
+        i++;
+        printf(".");
+    }
+    printf("\r\n");
+    // Check to see if erase operation lasted longer than 20 sec...
+    if (i >=200) {
+        printf("Second Message took too long'\r\n");
+        return FALSE;
+    }
+
+    // Confirm erase was successful?
+    // (Note: no acknowledgements used for some reason)
+    if (!can_send_timeout (T7SEC_ID, T7_erase_confirm, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        return FALSE;
+    }
+    if (!can_wait_timeout(T7SEC_RX, data, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        return FALSE;
+    }
+    if ( data[3] != 0x7E ) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        return FALSE;
+    }
+    wait_ms(100);
+    if (!can_send_timeout (T7SEC_ID, T7_erase_confirm, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        return FALSE;
+    }
+    if (!can_wait_timeout(T7SEC_RX, data, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        return FALSE;
+    }
+    if ( data[3] != 0x7E ) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        return FALSE;
+    }
+    printf("SUCCESS: The FLASH has been erased.\r\n");
+    return TRUE;
+}
+
+bool t7_flash() {
+    char T7_flash_jumpa[]   = T7FLAJP1A;
+    char T7_flash_jumpb[]   = T7FLAJP1B;
+    char T7_flash_end[]     = T7FLA_END;
+    char T7_flash_exit[]    = T7FLAEXIT;
+    char T7_flash_ack[]     = T7FLA_ACK;
+    char data[8];
+    int i, k;
+
+    // fopen modified.hex here?
+    // need lots of fcloses though
+    printf("Checking the FLASH BIN file...\r\n");
+    FILE *fp = fopen("/local/modified.hex", "r");    // Open "modified.hex" on the local file system for reading
+    if (!fp) {
+        printf("Error: I could not find the BIN file MODIFIED.HEX\r\n");;
+        return TERM_ERR;
+    }
+    // obtain file size - it should match the size of the FLASH chips:
+    fseek (fp , 0 , SEEK_END);
+    uint32_t file_size = ftell (fp);
+    rewind (fp);
+
+    // read the initial stack pointer value in the BIN file - it should match the value expected for the type of ECU
+    uint8_t stack_byte = 0;
+    uint32_t stack_long = 0;
+    if (!fread(&stack_byte,1,1,fp)) return TERM_ERR;
+    stack_long |= (stack_byte << 24);
+    if (!fread(&stack_byte,1,1,fp)) return TERM_ERR;
+    stack_long |= (stack_byte << 16);
+    if (!fread(&stack_byte,1,1,fp)) return TERM_ERR;
+    stack_long |= (stack_byte << 8);
+    if (!fread(&stack_byte,1,1,fp)) return TERM_ERR;
+    stack_long |= stack_byte;
+    rewind (fp);
+
+    if (file_size != T7FLASHSIZE || stack_long != T7POINTER) {
+        fclose(fp);
+        printf("The BIN file does not appear to be for a T7 ECU :-(\r\n");
+        printf("BIN file size: %#010x, FLASH chip size: %#010x, Pointer: %#010x.\r\n", file_size, T7FLASHSIZE, stack_long);
+        return TERM_ERR;
+    }
+
+    timer.reset();
+    timer.start();
+
+    // Send "Request Download - tool to module" to Trionic
+    if (!can_send_timeout (T7SEC_ID, T7_flash_jumpa, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if (!can_send_timeout (T7SEC_ID, T7_flash_jumpb, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if (!can_wait_timeout(T7SEC_RX, data, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    T7_flash_ack[3] = data[0] & 0xBF;
+    if (!can_send_timeout (T7ACK_ID, T7_flash_ack, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if ( data[3] != 0x74 ) {
+        printf("Cannot Update FLASH, message refused.\r\n");
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+
+    uint32_t address = 0;
+
+    printf("       %% complete.\r");
+    while (address < T7FLASHSIZE) {
+
+        data[0] = 0x4A; // 0x40 send, | 0x0A (10) messages to follow
+//        data[0] = 0x42; // 0x40 send, | 0x02 (2) messages to follow
+//        data[0] = 0x40; // 0x40 send, | 0x00 (0) messages to follow
+        data[1] = 0xA1;
+        data[2] = 0x41; // length+1 (64 Bytes)
+//        data[2] = 0x11; // length+1 (16 Bytes)
+//        data[2] = 0x05; // length+1 (4 Bytes)
+        data[3] = 0x36; // Data Transfer
+        for ( k = 4; k < 8; k++ )
+            //data[k] = *(bin + bin_count++);
+            if (!fread(&data[k],1,1,fp)) {
+                fclose(fp);
+                printf("Error reading the BIN file MODIFIED.HEX");
+                return FALSE;
+            }
+//      /* DEBUG info...
+//        for (k = 0; k < 8; k++ ) printf("0x%02X ", data[k] );
+//        for (k = 2; k < 8; k++ ) printf("%c ", data[k] );
+//        printf(" data\r\n");
+
+        if (!can_send_timeout (T7SEC_ID, data, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+//*
+        for (i = 9; i>=0; i--) {
+//        for (i = 1; i>=0; i--) {
+            data[0] = i;
+            // data[1] = 0xA1;
+            for ( k = 2; k < 8; k++ )
+                //data[k] = *(bin + bin_count++);
+                if (!fread(&data[k],1,1,fp)) {
+                    fclose(fp);
+                    printf("Error reading the BIN file MODIFIED.HEX");
+                    return FALSE;
+                }
+//            /* DEBUG info...
+//            for (k = 0; k < 8; k++ ) printf("0x%02X ", data[k] );
+//            for (k = 2; k < 8; k++ ) printf("%c ", data[k] );
+//            printf(" data\r\n");
+
+//            printf("%6.2f\r", 100*(float)address/(float)T7FLASHSIZE );
+            wait_ms(1);
+            if (!can_send_timeout (T7SEC_ID, data, 8, T7MESSAGETIMEOUT)) {
+                printf("err t7utils line: %d\r\n", __LINE__ );
+                fclose(fp);
+                return FALSE;
+            }
+        }
+//*/
+        address += 0x40;
+//        address += 0x10;
+//        address += 0x04;
+        if (!can_wait_timeout(T7SEC_RX, data, 8, T7LONGERTIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        // Send acknowledgement
+        T7_flash_ack[3] = data[0] & 0xBF;
+        if (!can_send_timeout (T7ACK_ID, T7_flash_ack, 8, T7MESSAGETIMEOUT)) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        if ( data[3] != 0x76 ) {
+            printf("err t7utils line: %d\r\n", __LINE__ );
+            fclose(fp);
+            return FALSE;
+        }
+        if (!(address % 0x80))
+            printf("%6.2f\r", 100*(float)address/(float)T7FLASHSIZE );
+    }
+    printf("\n");
+/*
+    // Send "Request Data Transfer Exit" to Trionic
+    if (!can_send_timeout (T7SEC_ID, T7_flash_end, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if (!can_wait_timeout(T7SEC_RX, data, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    T7_flash_ack[3] = data[0] & 0xBF;
+    if (!can_send_timeout (T7ACK_ID, T7_flash_ack, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if ( data[3] != 0x77 ) {
+        printf("Cannot Update FLASH, message refused.\r\n");
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    // Send "Request Data Transfer Exit" to Trionic
+    if (!can_send_timeout (T7SEC_ID, T7_flash_exit, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if (!can_wait_timeout(T7SEC_RX, data, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    T7_flash_ack[3] = data[0] & 0xBF;
+    if (!can_send_timeout (T7ACK_ID, T7_flash_ack, 8, T7MESSAGETIMEOUT)) {
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+    if ( data[3] != 0x71 ) {
+        printf("Cannot Update FLASH, message refused.\r\n");
+        printf("err t7utils line: %d\r\n", __LINE__ );
+        fclose(fp);
+        return FALSE;
+    }
+*/
+    timer.stop();
+    printf("SUCCESS! Programming the FLASH took %#.1f seconds.\r\n",timer.read());
+    fclose(fp);
+    return TRUE;
+}
\ No newline at end of file