Code to load a LPC1114 over tx/rx. I have only tested with a 1114 chip but it should work with other LPC uControllers
Dependencies: DirectoryList MODSERIAL mbed
Fork of ika_shouyu_poppoyaki by
verification.cpp@26:a63e73885b21, 2013-09-13 (annotated)
- Committer:
- okano
- Date:
- Fri Sep 13 12:56:23 2013 +0000
- Revision:
- 26:a63e73885b21
- Parent:
- 24:9830b4f1207b
- Child:
- 27:2b5c1eb39bb5
code is still dirty but it works. I hope I will have chance to clean up some day...
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
okano | 24:9830b4f1207b | 1 | #include "mbed.h" |
okano | 24:9830b4f1207b | 2 | #include "verification.h" |
okano | 24:9830b4f1207b | 3 | #include "command_interface.h" |
okano | 24:9830b4f1207b | 4 | #include "uu_coding.h" |
okano | 24:9830b4f1207b | 5 | #include "serial_utilities.h" |
okano | 24:9830b4f1207b | 6 | #include "writing.h" |
okano | 24:9830b4f1207b | 7 | #include "ika.h" |
okano | 24:9830b4f1207b | 8 | |
okano | 24:9830b4f1207b | 9 | int verify_binary_data( FILE *fp ); |
okano | 24:9830b4f1207b | 10 | int verify_uucoded_data( FILE *fp ); |
okano | 24:9830b4f1207b | 11 | void get_binary_from_uucode_str( char *b, int size ); |
okano | 24:9830b4f1207b | 12 | |
okano | 24:9830b4f1207b | 13 | |
okano | 24:9830b4f1207b | 14 | int verify_flash( FILE *fp, target_param *tpp ) |
okano | 24:9830b4f1207b | 15 | { |
okano | 24:9830b4f1207b | 16 | if ( tpp->write_type == BINARY ) |
okano | 24:9830b4f1207b | 17 | verify_binary_data( fp ); |
okano | 24:9830b4f1207b | 18 | else |
okano | 24:9830b4f1207b | 19 | verify_uucoded_data( fp ); |
okano | 26:a63e73885b21 | 20 | |
okano | 26:a63e73885b21 | 21 | return ( 0 ); // this is temporallry return code |
okano | 24:9830b4f1207b | 22 | } |
okano | 24:9830b4f1207b | 23 | |
okano | 24:9830b4f1207b | 24 | |
okano | 24:9830b4f1207b | 25 | int verify_binary_data( FILE *fp ) |
okano | 24:9830b4f1207b | 26 | { |
okano | 24:9830b4f1207b | 27 | char command_str[ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 28 | int read_size = 0; |
okano | 24:9830b4f1207b | 29 | int size; |
okano | 24:9830b4f1207b | 30 | int flash_reading_size; |
okano | 24:9830b4f1207b | 31 | char *bf; |
okano | 24:9830b4f1207b | 32 | char *br; |
okano | 24:9830b4f1207b | 33 | int error_flag = 0; |
okano | 24:9830b4f1207b | 34 | unsigned long checksum = 0; |
okano | 24:9830b4f1207b | 35 | unsigned long checksum_count = 0; |
okano | 24:9830b4f1207b | 36 | |
okano | 24:9830b4f1207b | 37 | fseek( fp, 0, SEEK_SET ); // seek back to beginning of file |
okano | 24:9830b4f1207b | 38 | |
okano | 24:9830b4f1207b | 39 | flash_reading_size = 128; |
okano | 24:9830b4f1207b | 40 | |
okano | 24:9830b4f1207b | 41 | if ( NULL == (bf = (char *)malloc( flash_reading_size * sizeof( char ) )) ) |
okano | 24:9830b4f1207b | 42 | error( "malloc error happened (in verify process, file data buffer)\r\n" ); |
okano | 24:9830b4f1207b | 43 | |
okano | 24:9830b4f1207b | 44 | if ( NULL == (br = (char *)malloc( flash_reading_size * sizeof( char ) )) ) |
okano | 24:9830b4f1207b | 45 | error( "malloc error happened (in verify process, read data buffer)\r\n" ); |
okano | 24:9830b4f1207b | 46 | |
okano | 24:9830b4f1207b | 47 | |
okano | 24:9830b4f1207b | 48 | while ( size = fread( bf, sizeof( char ), flash_reading_size, fp ) ) { |
okano | 24:9830b4f1207b | 49 | |
okano | 24:9830b4f1207b | 50 | if ( read_size < 0x20 ) { |
okano | 24:9830b4f1207b | 51 | for ( int i = 0; i < flash_reading_size; i += 4 ) { |
okano | 24:9830b4f1207b | 52 | |
okano | 24:9830b4f1207b | 53 | if ( checksum_count == 7 ) { |
okano | 24:9830b4f1207b | 54 | checksum = 0xFFFFFFFF - checksum + 1; |
okano | 24:9830b4f1207b | 55 | *((unsigned int *)(bf + i)) = checksum; |
okano | 26:a63e73885b21 | 56 | //printf( "\r\n\r\n -- calculated checksum : 0x%08X\r\n", checksum ); |
okano | 24:9830b4f1207b | 57 | } else { |
okano | 24:9830b4f1207b | 58 | checksum += *((unsigned int *)(bf + i)); |
okano | 24:9830b4f1207b | 59 | } |
okano | 26:a63e73885b21 | 60 | |
okano | 24:9830b4f1207b | 61 | checksum_count++; |
okano | 24:9830b4f1207b | 62 | } |
okano | 24:9830b4f1207b | 63 | } |
okano | 24:9830b4f1207b | 64 | |
okano | 24:9830b4f1207b | 65 | |
okano | 24:9830b4f1207b | 66 | sprintf( command_str, "R %ld %ld\r\n", read_size, size ); |
okano | 24:9830b4f1207b | 67 | // try_and_check( command_str, "0", MODE_SILENT ); |
okano | 24:9830b4f1207b | 68 | try_and_check( command_str, "0", 0 ); |
okano | 24:9830b4f1207b | 69 | |
okano | 24:9830b4f1207b | 70 | get_binary( br, 1 ); |
okano | 24:9830b4f1207b | 71 | get_binary( br, size ); |
okano | 24:9830b4f1207b | 72 | |
okano | 24:9830b4f1207b | 73 | for ( int i = 0; i < size; i++ ) { |
okano | 24:9830b4f1207b | 74 | // printf( " %s 0x%02X --- 0x%02X\r\n", (*(bf + i) != *(br + i)) ? "***" : " ", *(bf + i), *(br + i) ); |
okano | 24:9830b4f1207b | 75 | if ( (*(bf + i) != *(br + i)) ) { |
okano | 24:9830b4f1207b | 76 | // printf( " %s 0x%02X --- 0x%02X\r\n", (*(bf + i) != *(br + i)) ? "***" : " ", *(bf + i), *(br + i) ); |
okano | 24:9830b4f1207b | 77 | error_flag++; |
okano | 24:9830b4f1207b | 78 | } |
okano | 24:9830b4f1207b | 79 | } |
okano | 24:9830b4f1207b | 80 | |
okano | 24:9830b4f1207b | 81 | if ( error_flag ) |
okano | 24:9830b4f1207b | 82 | break; |
okano | 26:a63e73885b21 | 83 | |
okano | 24:9830b4f1207b | 84 | read_size += size; |
okano | 24:9830b4f1207b | 85 | |
okano | 24:9830b4f1207b | 86 | // printf( " total %d bytes read\r\n", read_size ); |
okano | 24:9830b4f1207b | 87 | } |
okano | 26:a63e73885b21 | 88 | |
okano | 24:9830b4f1207b | 89 | error_state |= error_flag; |
okano | 24:9830b4f1207b | 90 | |
okano | 24:9830b4f1207b | 91 | printf( " total %d bytes read\r", read_size ); |
okano | 24:9830b4f1207b | 92 | printf( " verification result : \"%s\"\r\n", error_flag ? "Fail" : "Pass" ); |
okano | 24:9830b4f1207b | 93 | |
okano | 24:9830b4f1207b | 94 | free( bf ); |
okano | 24:9830b4f1207b | 95 | free( br ); |
okano | 24:9830b4f1207b | 96 | |
okano | 24:9830b4f1207b | 97 | return ( read_size ); |
okano | 24:9830b4f1207b | 98 | } |
okano | 24:9830b4f1207b | 99 | |
okano | 24:9830b4f1207b | 100 | |
okano | 24:9830b4f1207b | 101 | int verify_uucoded_data( FILE *fp ) |
okano | 24:9830b4f1207b | 102 | { |
okano | 24:9830b4f1207b | 103 | char command_str[ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 104 | int read_size = 0; |
okano | 24:9830b4f1207b | 105 | int size; |
okano | 24:9830b4f1207b | 106 | int flash_reading_size; |
okano | 24:9830b4f1207b | 107 | char *bf; |
okano | 24:9830b4f1207b | 108 | char *br; |
okano | 24:9830b4f1207b | 109 | int error_flag = 0; |
okano | 24:9830b4f1207b | 110 | |
okano | 24:9830b4f1207b | 111 | flash_reading_size = 176; |
okano | 24:9830b4f1207b | 112 | |
okano | 24:9830b4f1207b | 113 | initialize_uud_table(); |
okano | 24:9830b4f1207b | 114 | |
okano | 24:9830b4f1207b | 115 | if ( NULL == (bf = (char *)malloc( flash_reading_size * sizeof( char ) )) ) |
okano | 24:9830b4f1207b | 116 | error( "malloc error happened (in verify process, file data buffer)\r\n" ); |
okano | 24:9830b4f1207b | 117 | |
okano | 24:9830b4f1207b | 118 | if ( NULL == (br = (char *)malloc( flash_reading_size * sizeof( char ) )) ) |
okano | 24:9830b4f1207b | 119 | error( "malloc error happened (in verify process, read data buffer)\r\n" ); |
okano | 24:9830b4f1207b | 120 | |
okano | 24:9830b4f1207b | 121 | fseek( fp, 0, SEEK_SET ); // seek back to beginning of file |
okano | 24:9830b4f1207b | 122 | |
okano | 24:9830b4f1207b | 123 | while ( size = fread( bf, sizeof( char ), flash_reading_size, fp ) ) { |
okano | 24:9830b4f1207b | 124 | |
okano | 24:9830b4f1207b | 125 | if ( !read_size ) { |
okano | 24:9830b4f1207b | 126 | // overwriting 4 bytes data for address=0x1C |
okano | 24:9830b4f1207b | 127 | // there is a slot for checksum that is checked in (target's) boot process |
okano | 24:9830b4f1207b | 128 | add_isp_checksum( bf ); |
okano | 24:9830b4f1207b | 129 | } |
okano | 24:9830b4f1207b | 130 | |
okano | 24:9830b4f1207b | 131 | sprintf( command_str, "R %ld %ld\r\n", read_size, size ); |
okano | 24:9830b4f1207b | 132 | try_and_check( command_str, "0", 0 ); |
okano | 24:9830b4f1207b | 133 | |
okano | 24:9830b4f1207b | 134 | get_binary_from_uucode_str( br, size ); |
okano | 24:9830b4f1207b | 135 | |
okano | 24:9830b4f1207b | 136 | for ( int i = 0; i < size; i++ ) { |
okano | 24:9830b4f1207b | 137 | // printf( " %s 0x%02X --- 0x%02X\r\n", (*(bf + i) != *(br + i)) ? "***" : " ", *(bf + i), *(br + i) ); |
okano | 24:9830b4f1207b | 138 | if ( (*(bf + i) != *(br + i)) ) { |
okano | 24:9830b4f1207b | 139 | printf( " %s 0x%02X --- 0x%02X\r\n", (*(bf + i) != *(br + i)) ? "***" : " ", *(bf + i), *(br + i) ); |
okano | 24:9830b4f1207b | 140 | error_flag++; |
okano | 24:9830b4f1207b | 141 | } |
okano | 24:9830b4f1207b | 142 | } |
okano | 24:9830b4f1207b | 143 | |
okano | 24:9830b4f1207b | 144 | if ( error_flag ) |
okano | 24:9830b4f1207b | 145 | break; |
okano | 26:a63e73885b21 | 146 | |
okano | 24:9830b4f1207b | 147 | read_size += size; |
okano | 24:9830b4f1207b | 148 | // printf( " total %d bytes read\r", read_size ); |
okano | 24:9830b4f1207b | 149 | } |
okano | 24:9830b4f1207b | 150 | |
okano | 24:9830b4f1207b | 151 | error_state |= error_flag; |
okano | 24:9830b4f1207b | 152 | |
okano | 24:9830b4f1207b | 153 | printf( " total %d bytes read\r", read_size ); |
okano | 24:9830b4f1207b | 154 | printf( " verification result : \"%s\"\r\n", error_flag ? "Fail" : "Pass" ); |
okano | 24:9830b4f1207b | 155 | |
okano | 24:9830b4f1207b | 156 | free( bf ); |
okano | 24:9830b4f1207b | 157 | free( br ); |
okano | 24:9830b4f1207b | 158 | |
okano | 24:9830b4f1207b | 159 | return ( read_size ); |
okano | 24:9830b4f1207b | 160 | } |
okano | 24:9830b4f1207b | 161 | |
okano | 24:9830b4f1207b | 162 | |
okano | 24:9830b4f1207b | 163 | void get_binary_from_uucode_str( char *b, int size ) |
okano | 24:9830b4f1207b | 164 | { |
okano | 24:9830b4f1207b | 165 | #define N 4 |
okano | 24:9830b4f1207b | 166 | |
okano | 24:9830b4f1207b | 167 | char s[ N ][ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 168 | char ss[ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 169 | long checksum = 0; |
okano | 24:9830b4f1207b | 170 | int line_count = 0; |
okano | 24:9830b4f1207b | 171 | int read_size = 0; |
okano | 24:9830b4f1207b | 172 | int retry_count = 3; |
okano | 24:9830b4f1207b | 173 | |
okano | 24:9830b4f1207b | 174 | |
okano | 24:9830b4f1207b | 175 | while ( retry_count-- ) { |
okano | 24:9830b4f1207b | 176 | |
okano | 24:9830b4f1207b | 177 | for ( int i = 0; i < N; i++ ) |
okano | 24:9830b4f1207b | 178 | get_string( s[ i ] ); |
okano | 24:9830b4f1207b | 179 | |
okano | 24:9830b4f1207b | 180 | get_string( ss ); |
okano | 24:9830b4f1207b | 181 | |
okano | 24:9830b4f1207b | 182 | |
okano | 24:9830b4f1207b | 183 | while ( size ) { |
okano | 24:9830b4f1207b | 184 | read_size = uudecode_a_line( b, s[ line_count ] ); |
okano | 24:9830b4f1207b | 185 | |
okano | 24:9830b4f1207b | 186 | for ( int i = 0; i < read_size; i++ ) |
okano | 24:9830b4f1207b | 187 | checksum += *b++; |
okano | 24:9830b4f1207b | 188 | |
okano | 24:9830b4f1207b | 189 | size -= read_size; |
okano | 24:9830b4f1207b | 190 | line_count++; |
okano | 24:9830b4f1207b | 191 | } |
okano | 24:9830b4f1207b | 192 | |
okano | 24:9830b4f1207b | 193 | // printf( " checksum -- %s (internal = %ld)\r\n", ss, checksum ); |
okano | 24:9830b4f1207b | 194 | |
okano | 24:9830b4f1207b | 195 | if ( checksum == atol( ss ) ) { |
okano | 24:9830b4f1207b | 196 | put_string( "OK\r\n" ); |
okano | 24:9830b4f1207b | 197 | return; |
okano | 24:9830b4f1207b | 198 | // printf( " checksum OK\r\n" ); |
okano | 24:9830b4f1207b | 199 | } else { |
okano | 24:9830b4f1207b | 200 | printf( " checksum RESEND\r\n" ); |
okano | 24:9830b4f1207b | 201 | put_string( "RESEND\r\n" ); |
okano | 24:9830b4f1207b | 202 | } |
okano | 24:9830b4f1207b | 203 | } |
okano | 24:9830b4f1207b | 204 | } |