Add to 11U68 11E68
Dependencies: DirectoryList MODSERIAL mbed
Fork of ika_shouyu_poppoyaki by
verification.cpp@39:f68f9fa1e88e, 2013-09-29 (annotated)
- Committer:
- okano
- Date:
- Sun Sep 29 03:54:06 2013 +0000
- Revision:
- 39:f68f9fa1e88e
- Parent:
- 38:cb95bfe0546a
- Child:
- 40:615dc8275648
ver 0.98 : suppressed debug message in default setting. it improves speed of writing and verifying
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 | 30:e0d7524661ca | 7 | #include "isp.h" |
okano | 28:689c3880e0e4 | 8 | |
okano | 24:9830b4f1207b | 9 | |
okano | 29:96e28bc1bd99 | 10 | int verify_binary_data( FILE *fp, int *transferred_size_p ); |
okano | 29:96e28bc1bd99 | 11 | int verify_uucoded_data( FILE *fp, int *transferred_size_p ); |
okano | 24:9830b4f1207b | 12 | void get_binary_from_uucode_str( char *b, int size ); |
okano | 24:9830b4f1207b | 13 | |
okano | 24:9830b4f1207b | 14 | |
okano | 29:96e28bc1bd99 | 15 | int verify_flash( FILE *fp, target_param *tpp, int *transferred_size_p ) |
okano | 24:9830b4f1207b | 16 | { |
okano | 24:9830b4f1207b | 17 | if ( tpp->write_type == BINARY ) |
okano | 29:96e28bc1bd99 | 18 | return ( verify_binary_data( fp, transferred_size_p ) ); |
okano | 24:9830b4f1207b | 19 | else |
okano | 29:96e28bc1bd99 | 20 | return ( verify_uucoded_data( fp, transferred_size_p ) ); |
okano | 24:9830b4f1207b | 21 | } |
okano | 24:9830b4f1207b | 22 | |
okano | 24:9830b4f1207b | 23 | |
okano | 29:96e28bc1bd99 | 24 | int verify_binary_data( FILE *fp, int *read_size_p ) |
okano | 24:9830b4f1207b | 25 | { |
okano | 24:9830b4f1207b | 26 | char command_str[ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 27 | int read_size = 0; |
okano | 24:9830b4f1207b | 28 | int size; |
okano | 24:9830b4f1207b | 29 | int flash_reading_size; |
okano | 24:9830b4f1207b | 30 | char *bf; |
okano | 24:9830b4f1207b | 31 | char *br; |
okano | 24:9830b4f1207b | 32 | int error_flag = 0; |
okano | 24:9830b4f1207b | 33 | unsigned long checksum = 0; |
okano | 24:9830b4f1207b | 34 | unsigned long checksum_count = 0; |
okano | 24:9830b4f1207b | 35 | |
okano | 29:96e28bc1bd99 | 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 | 28:689c3880e0e4 | 42 | return( ERROR_AT_MALLOC_FOR_VERIFY_FILE_BUFF ); |
okano | 24:9830b4f1207b | 43 | |
okano | 24:9830b4f1207b | 44 | if ( NULL == (br = (char *)malloc( flash_reading_size * sizeof( char ) )) ) |
okano | 28:689c3880e0e4 | 45 | return( ERROR_AT_MALLOC_FOR_VERIFY_DATA_BUFF ); |
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 | 38:cb95bfe0546a | 66 | sprintf( command_str, "R %ld %ld\r\n", read_size, (size + 3) & ~0x3 ); // reading size must be 4*N |
okano | 35:0b434ef4af49 | 67 | if ( try_and_check( command_str, "0" ) ) |
okano | 27:2b5c1eb39bb5 | 68 | return ( ERROR_AT_READ_COMMAND ); |
okano | 24:9830b4f1207b | 69 | |
okano | 39:f68f9fa1e88e | 70 | wait_ms( 1 ); |
okano | 24:9830b4f1207b | 71 | get_binary( br, 1 ); |
okano | 24:9830b4f1207b | 72 | get_binary( br, size ); |
okano | 24:9830b4f1207b | 73 | |
okano | 24:9830b4f1207b | 74 | for ( int i = 0; i < size; i++ ) { |
okano | 24:9830b4f1207b | 75 | // printf( " %s 0x%02X --- 0x%02X\r\n", (*(bf + i) != *(br + i)) ? "***" : " ", *(bf + i), *(br + i) ); |
okano | 24:9830b4f1207b | 76 | if ( (*(bf + i) != *(br + i)) ) { |
okano | 24:9830b4f1207b | 77 | // printf( " %s 0x%02X --- 0x%02X\r\n", (*(bf + i) != *(br + i)) ? "***" : " ", *(bf + i), *(br + i) ); |
okano | 24:9830b4f1207b | 78 | error_flag++; |
okano | 24:9830b4f1207b | 79 | } |
okano | 24:9830b4f1207b | 80 | } |
okano | 24:9830b4f1207b | 81 | |
okano | 24:9830b4f1207b | 82 | if ( error_flag ) |
okano | 24:9830b4f1207b | 83 | break; |
okano | 26:a63e73885b21 | 84 | |
okano | 24:9830b4f1207b | 85 | read_size += size; |
okano | 24:9830b4f1207b | 86 | } |
okano | 26:a63e73885b21 | 87 | |
okano | 24:9830b4f1207b | 88 | free( bf ); |
okano | 24:9830b4f1207b | 89 | free( br ); |
okano | 24:9830b4f1207b | 90 | |
okano | 29:96e28bc1bd99 | 91 | *read_size_p = read_size; |
okano | 29:96e28bc1bd99 | 92 | |
okano | 27:2b5c1eb39bb5 | 93 | return ( error_flag ? ERROR_DATA_DOES_NOT_MATCH : NO_ERROR ); |
okano | 24:9830b4f1207b | 94 | } |
okano | 24:9830b4f1207b | 95 | |
okano | 24:9830b4f1207b | 96 | |
okano | 34:eaca33d3e632 | 97 | #define LINE_BYTES 44 |
okano | 34:eaca33d3e632 | 98 | #define N_OF_LINES 4 |
okano | 34:eaca33d3e632 | 99 | #define READ_SIZE (LINE_BYTES * N_OF_LINES) |
okano | 34:eaca33d3e632 | 100 | |
okano | 34:eaca33d3e632 | 101 | |
okano | 29:96e28bc1bd99 | 102 | int verify_uucoded_data( FILE *fp, int *read_size_p ) |
okano | 24:9830b4f1207b | 103 | { |
okano | 24:9830b4f1207b | 104 | char command_str[ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 105 | int read_size = 0; |
okano | 24:9830b4f1207b | 106 | int size; |
okano | 24:9830b4f1207b | 107 | int flash_reading_size; |
okano | 24:9830b4f1207b | 108 | char *bf; |
okano | 24:9830b4f1207b | 109 | char *br; |
okano | 24:9830b4f1207b | 110 | int error_flag = 0; |
okano | 24:9830b4f1207b | 111 | |
okano | 34:eaca33d3e632 | 112 | flash_reading_size = READ_SIZE; |
okano | 24:9830b4f1207b | 113 | |
okano | 24:9830b4f1207b | 114 | initialize_uud_table(); |
okano | 24:9830b4f1207b | 115 | |
okano | 24:9830b4f1207b | 116 | if ( NULL == (bf = (char *)malloc( flash_reading_size * sizeof( char ) )) ) |
okano | 24:9830b4f1207b | 117 | error( "malloc error happened (in verify process, file data buffer)\r\n" ); |
okano | 24:9830b4f1207b | 118 | |
okano | 24:9830b4f1207b | 119 | if ( NULL == (br = (char *)malloc( flash_reading_size * sizeof( char ) )) ) |
okano | 24:9830b4f1207b | 120 | error( "malloc error happened (in verify process, read data buffer)\r\n" ); |
okano | 24:9830b4f1207b | 121 | |
okano | 24:9830b4f1207b | 122 | fseek( fp, 0, SEEK_SET ); // seek back to beginning of file |
okano | 24:9830b4f1207b | 123 | |
okano | 24:9830b4f1207b | 124 | while ( size = fread( bf, sizeof( char ), flash_reading_size, fp ) ) { |
okano | 24:9830b4f1207b | 125 | |
okano | 24:9830b4f1207b | 126 | if ( !read_size ) { |
okano | 24:9830b4f1207b | 127 | // overwriting 4 bytes data for address=0x1C |
okano | 24:9830b4f1207b | 128 | // there is a slot for checksum that is checked in (target's) boot process |
okano | 24:9830b4f1207b | 129 | add_isp_checksum( bf ); |
okano | 24:9830b4f1207b | 130 | } |
okano | 24:9830b4f1207b | 131 | |
okano | 38:cb95bfe0546a | 132 | sprintf( command_str, "R %ld %ld\r\n", read_size, (size + 3) & ~0x3 ); // reading size must be 4*N |
okano | 35:0b434ef4af49 | 133 | if ( try_and_check( command_str, "0" ) ) |
okano | 27:2b5c1eb39bb5 | 134 | return ( ERROR_AT_READ_COMMAND ); |
okano | 24:9830b4f1207b | 135 | |
okano | 24:9830b4f1207b | 136 | get_binary_from_uucode_str( br, size ); |
okano | 24:9830b4f1207b | 137 | |
okano | 24:9830b4f1207b | 138 | for ( int i = 0; i < size; 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 | if ( (*(bf + i) != *(br + i)) ) { |
okano | 38:cb95bfe0546a | 141 | // printf( " %s 0x%02X --- 0x%02X\r\n", (*(bf + i) != *(br + i)) ? "***" : " ", *(bf + i), *(br + i) ); |
okano | 24:9830b4f1207b | 142 | error_flag++; |
okano | 24:9830b4f1207b | 143 | } |
okano | 24:9830b4f1207b | 144 | } |
okano | 24:9830b4f1207b | 145 | |
okano | 24:9830b4f1207b | 146 | if ( error_flag ) |
okano | 24:9830b4f1207b | 147 | break; |
okano | 26:a63e73885b21 | 148 | |
okano | 24:9830b4f1207b | 149 | read_size += size; |
okano | 24:9830b4f1207b | 150 | } |
okano | 24:9830b4f1207b | 151 | |
okano | 24:9830b4f1207b | 152 | free( bf ); |
okano | 24:9830b4f1207b | 153 | free( br ); |
okano | 24:9830b4f1207b | 154 | |
okano | 29:96e28bc1bd99 | 155 | *read_size_p = read_size; |
okano | 29:96e28bc1bd99 | 156 | |
okano | 27:2b5c1eb39bb5 | 157 | return ( error_flag ? ERROR_DATA_DOES_NOT_MATCH : NO_ERROR ); |
okano | 24:9830b4f1207b | 158 | } |
okano | 24:9830b4f1207b | 159 | |
okano | 24:9830b4f1207b | 160 | |
okano | 24:9830b4f1207b | 161 | void get_binary_from_uucode_str( char *b, int size ) |
okano | 24:9830b4f1207b | 162 | { |
okano | 34:eaca33d3e632 | 163 | char s[ N_OF_LINES ][ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 164 | char ss[ STR_BUFF_SIZE ]; |
okano | 24:9830b4f1207b | 165 | long checksum = 0; |
okano | 24:9830b4f1207b | 166 | int line_count = 0; |
okano | 24:9830b4f1207b | 167 | int read_size = 0; |
okano | 24:9830b4f1207b | 168 | int retry_count = 3; |
okano | 24:9830b4f1207b | 169 | |
okano | 38:cb95bfe0546a | 170 | size = (size + 3) & ~0x3; |
okano | 24:9830b4f1207b | 171 | |
okano | 24:9830b4f1207b | 172 | while ( retry_count-- ) { |
okano | 24:9830b4f1207b | 173 | |
okano | 34:eaca33d3e632 | 174 | for ( int i = 0; i < ((READ_SIZE < size) ? N_OF_LINES : ((size - 1) / LINE_BYTES) + 1) ; i++ ) |
okano | 24:9830b4f1207b | 175 | get_string( s[ i ] ); |
okano | 24:9830b4f1207b | 176 | |
okano | 24:9830b4f1207b | 177 | get_string( ss ); |
okano | 24:9830b4f1207b | 178 | |
okano | 24:9830b4f1207b | 179 | |
okano | 24:9830b4f1207b | 180 | while ( size ) { |
okano | 24:9830b4f1207b | 181 | read_size = uudecode_a_line( b, s[ line_count ] ); |
okano | 24:9830b4f1207b | 182 | |
okano | 24:9830b4f1207b | 183 | for ( int i = 0; i < read_size; i++ ) |
okano | 24:9830b4f1207b | 184 | checksum += *b++; |
okano | 24:9830b4f1207b | 185 | |
okano | 24:9830b4f1207b | 186 | size -= read_size; |
okano | 24:9830b4f1207b | 187 | line_count++; |
okano | 24:9830b4f1207b | 188 | } |
okano | 24:9830b4f1207b | 189 | |
okano | 24:9830b4f1207b | 190 | // printf( " checksum -- %s (internal = %ld)\r\n", ss, checksum ); |
okano | 24:9830b4f1207b | 191 | |
okano | 24:9830b4f1207b | 192 | if ( checksum == atol( ss ) ) { |
okano | 24:9830b4f1207b | 193 | put_string( "OK\r\n" ); |
okano | 24:9830b4f1207b | 194 | return; |
okano | 24:9830b4f1207b | 195 | // printf( " checksum OK\r\n" ); |
okano | 24:9830b4f1207b | 196 | } else { |
okano | 24:9830b4f1207b | 197 | printf( " checksum RESEND\r\n" ); |
okano | 24:9830b4f1207b | 198 | put_string( "RESEND\r\n" ); |
okano | 24:9830b4f1207b | 199 | } |
okano | 24:9830b4f1207b | 200 | } |
okano | 24:9830b4f1207b | 201 | } |