mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 """
be_bryan 0:b74591d5ab33 2 @copyright (c) 2012 ON Semiconductor. All rights reserved.
be_bryan 0:b74591d5ab33 3 ON Semiconductor is supplying this software for use with ON Semiconductor
be_bryan 0:b74591d5ab33 4 processor based microcontrollers only.
be_bryan 0:b74591d5ab33 5 THIS SOFTWARE IS PROVIDED "AS IS". NO WARRANTIES, WHETHER EXPRESS, IMPLIED
be_bryan 0:b74591d5ab33 6 OR STATUTORY, INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF
be_bryan 0:b74591d5ab33 7 MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE APPLY TO THIS SOFTWARE.
be_bryan 0:b74591d5ab33 8 ON SEMICONDUCTOR SHALL NOT, IN ANY CIRCUMSTANCES, BE LIABLE FOR SPECIAL,
be_bryan 0:b74591d5ab33 9 INCIDENTAL, OR CONSEQUENTIAL DAMAGES, FOR ANY REASON WHATSOEVER.
be_bryan 0:b74591d5ab33 10 """
be_bryan 0:b74591d5ab33 11
be_bryan 0:b74591d5ab33 12 from __future__ import absolute_import
be_bryan 0:b74591d5ab33 13 from __future__ import print_function
be_bryan 0:b74591d5ab33 14
be_bryan 0:b74591d5ab33 15 import itertools
be_bryan 0:b74591d5ab33 16 import binascii
be_bryan 0:b74591d5ab33 17 import intelhex
be_bryan 0:b74591d5ab33 18 from tools.config import Config
be_bryan 0:b74591d5ab33 19
be_bryan 0:b74591d5ab33 20 FIB_BASE = 0x2000
be_bryan 0:b74591d5ab33 21 TRIM_BASE = 0x2800
be_bryan 0:b74591d5ab33 22 FLASH_BASE = 0x3000
be_bryan 0:b74591d5ab33 23 FLASHA_SIZE = 0x52000
be_bryan 0:b74591d5ab33 24 FLASHB_BASE = 0x00102000
be_bryan 0:b74591d5ab33 25 FLASHB_SIZE = 0x52000
be_bryan 0:b74591d5ab33 26 FW_REV = 0x01000100
be_bryan 0:b74591d5ab33 27
be_bryan 0:b74591d5ab33 28 def ranges(i):
be_bryan 0:b74591d5ab33 29 for _, b in itertools.groupby(enumerate(i), lambda x_y: x_y[1] - x_y[0]):
be_bryan 0:b74591d5ab33 30 b = list(b)
be_bryan 0:b74591d5ab33 31 yield b[0][1], b[-1][1]
be_bryan 0:b74591d5ab33 32
be_bryan 0:b74591d5ab33 33
be_bryan 0:b74591d5ab33 34 def add_fib_at_start(arginput):
be_bryan 0:b74591d5ab33 35 input_file = arginput + ".hex"
be_bryan 0:b74591d5ab33 36 file_name_hex = arginput + ".hex"
be_bryan 0:b74591d5ab33 37 file_name_bin = arginput + ".bin"
be_bryan 0:b74591d5ab33 38
be_bryan 0:b74591d5ab33 39 # Read in hex file
be_bryan 0:b74591d5ab33 40 input_hex_file = intelhex.IntelHex()
be_bryan 0:b74591d5ab33 41 input_hex_file.loadhex(input_file)
be_bryan 0:b74591d5ab33 42 #set padding value to be returned when reading from unspecified address
be_bryan 0:b74591d5ab33 43 input_hex_file.padding = 0xFF
be_bryan 0:b74591d5ab33 44 # Create new hex file
be_bryan 0:b74591d5ab33 45 output_hex_file = intelhex.IntelHex()
be_bryan 0:b74591d5ab33 46
be_bryan 0:b74591d5ab33 47 # Get the starting and ending address
be_bryan 0:b74591d5ab33 48 addresses = input_hex_file.addresses()
be_bryan 0:b74591d5ab33 49 addresses.sort()
be_bryan 0:b74591d5ab33 50 start_end_pairs = list(ranges(addresses))
be_bryan 0:b74591d5ab33 51 regions = len(start_end_pairs)
be_bryan 0:b74591d5ab33 52
be_bryan 0:b74591d5ab33 53 if regions == 1:
be_bryan 0:b74591d5ab33 54 #single range indicating fits within first flash block (<320K)
be_bryan 0:b74591d5ab33 55 start, end = start_end_pairs[0]
be_bryan 0:b74591d5ab33 56 print("Memory start 0x%08X, end 0x%08X" % (start, end))
be_bryan 0:b74591d5ab33 57 # Compute checksum over the range (don't include data at location of crc)
be_bryan 0:b74591d5ab33 58 size = end - start + 1
be_bryan 0:b74591d5ab33 59 data = input_hex_file.tobinarray(start=start, size=size)
be_bryan 0:b74591d5ab33 60 crc32 = binascii.crc32(data) & 0xFFFFFFFF
be_bryan 0:b74591d5ab33 61 else:
be_bryan 0:b74591d5ab33 62 #multiple ranges indicating requires both flash blocks (>320K)
be_bryan 0:b74591d5ab33 63 start, end = start_end_pairs[0]
be_bryan 0:b74591d5ab33 64 start2, end2 = start_end_pairs[1]
be_bryan 0:b74591d5ab33 65 print("Region 1: memory start 0x%08X, end 0x%08X" % (start, end))
be_bryan 0:b74591d5ab33 66 print("Region 2: memory start 0x%08X, end 0x%08X" % (start2, end2))
be_bryan 0:b74591d5ab33 67 # Compute checksum over the range (don't include data at location of crc)
be_bryan 0:b74591d5ab33 68 # replace end with end of flash block A
be_bryan 0:b74591d5ab33 69 end = FLASHA_SIZE - 1
be_bryan 0:b74591d5ab33 70 size = end - start + 1
be_bryan 0:b74591d5ab33 71 data = input_hex_file.tobinarray(start=start, size=size)
be_bryan 0:b74591d5ab33 72
be_bryan 0:b74591d5ab33 73 # replace start2 with base of flash block B
be_bryan 0:b74591d5ab33 74 start2 = FLASHB_BASE
be_bryan 0:b74591d5ab33 75 size2 = end2 - start2 + 1
be_bryan 0:b74591d5ab33 76 data2 = input_hex_file.tobinarray(start=start2, size=size2)
be_bryan 0:b74591d5ab33 77
be_bryan 0:b74591d5ab33 78 #concatenate data and data2 arrays together
be_bryan 0:b74591d5ab33 79 data.extend(data2)
be_bryan 0:b74591d5ab33 80 crc32 = binascii.crc32(data) & 0xFFFFFFFF
be_bryan 0:b74591d5ab33 81
be_bryan 0:b74591d5ab33 82 #replace size with sum of two memory region sizes
be_bryan 0:b74591d5ab33 83 size = size + size2
be_bryan 0:b74591d5ab33 84
be_bryan 0:b74591d5ab33 85 assert start >= FLASH_BASE, ("Error - start 0x%x less than begining of user\
be_bryan 0:b74591d5ab33 86 flash area" %start)
be_bryan 0:b74591d5ab33 87
be_bryan 0:b74591d5ab33 88 assert regions <= 2, ("Error - more than 2 memory regions found")
be_bryan 0:b74591d5ab33 89
be_bryan 0:b74591d5ab33 90 fw_rev = FW_REV
be_bryan 0:b74591d5ab33 91
be_bryan 0:b74591d5ab33 92 checksum = (start + size + crc32 + fw_rev) & 0xFFFFFFFF
be_bryan 0:b74591d5ab33 93
be_bryan 0:b74591d5ab33 94 print("Writing FIB: base 0x%08X, size 0x%08X, crc32 0x%08X, fw rev 0x%08X,\
be_bryan 0:b74591d5ab33 95 checksum 0x%08X" % (start, size, crc32, fw_rev, checksum))
be_bryan 0:b74591d5ab33 96
be_bryan 0:b74591d5ab33 97 #expected initial values used by daplink to validate that it is a valid bin
be_bryan 0:b74591d5ab33 98 #file added as dummy values in this file because the fib area preceeds the
be_bryan 0:b74591d5ab33 99 #application area the bootloader will ignore these dummy values
be_bryan 0:b74591d5ab33 100 # 00 is stack pointer (RAM address)
be_bryan 0:b74591d5ab33 101 # 04 is Reset vector (FLASH address)
be_bryan 0:b74591d5ab33 102 # 08 NMI_Handler (FLASH address)
be_bryan 0:b74591d5ab33 103 # 0C HardFault_Handler(FLASH address)
be_bryan 0:b74591d5ab33 104 # 10 dummy
be_bryan 0:b74591d5ab33 105 dummy_sp = 0x3FFFFC00
be_bryan 0:b74591d5ab33 106 dummy_reset_vector = 0x00003625
be_bryan 0:b74591d5ab33 107 dummy_nmi_handler = 0x00003761
be_bryan 0:b74591d5ab33 108 dummy_hardfault_handler = 0x00003691
be_bryan 0:b74591d5ab33 109 dummy_blank = 0x00000000
be_bryan 0:b74591d5ab33 110
be_bryan 0:b74591d5ab33 111 #expected fib structure
be_bryan 0:b74591d5ab33 112 #typedef struct fib{
be_bryan 0:b74591d5ab33 113 #uint32_t base; /**< Base offset of firmware, indicating what flash the
be_bryan 0:b74591d5ab33 114 # firmware is in. (will never be 0x11111111) */
be_bryan 0:b74591d5ab33 115 #uint32_t size; /**< Size of the firmware */
be_bryan 0:b74591d5ab33 116 #uint32_t crc; /**< CRC32 for firmware correctness check */
be_bryan 0:b74591d5ab33 117 #uint32_t rev; /**< Revision number */
be_bryan 0:b74591d5ab33 118 #uint32_t checksum; /**< Check-sum of information block */
be_bryan 0:b74591d5ab33 119 #}fib_t, *fib_pt;
be_bryan 0:b74591d5ab33 120
be_bryan 0:b74591d5ab33 121 fib_start = FIB_BASE
be_bryan 0:b74591d5ab33 122 dummy_fib_size = 20
be_bryan 0:b74591d5ab33 123 fib_size = 20
be_bryan 0:b74591d5ab33 124 trim_size = 24
be_bryan 0:b74591d5ab33 125 user_code_start = FLASH_BASE
be_bryan 0:b74591d5ab33 126 trim_area_start = TRIM_BASE
be_bryan 0:b74591d5ab33 127
be_bryan 0:b74591d5ab33 128 # Write FIB to the file in little endian
be_bryan 0:b74591d5ab33 129 output_hex_file[fib_start + 0] = (dummy_sp >> 0) & 0xFF
be_bryan 0:b74591d5ab33 130 output_hex_file[fib_start + 1] = (dummy_sp >> 8) & 0xFF
be_bryan 0:b74591d5ab33 131 output_hex_file[fib_start + 2] = (dummy_sp >> 16) & 0xFF
be_bryan 0:b74591d5ab33 132 output_hex_file[fib_start + 3] = (dummy_sp >> 24) & 0xFF
be_bryan 0:b74591d5ab33 133
be_bryan 0:b74591d5ab33 134 output_hex_file[fib_start + 4] = (dummy_reset_vector >> 0) & 0xFF
be_bryan 0:b74591d5ab33 135 output_hex_file[fib_start + 5] = (dummy_reset_vector >> 8) & 0xFF
be_bryan 0:b74591d5ab33 136 output_hex_file[fib_start + 6] = (dummy_reset_vector >> 16) & 0xFF
be_bryan 0:b74591d5ab33 137 output_hex_file[fib_start + 7] = (dummy_reset_vector >> 24) & 0xFF
be_bryan 0:b74591d5ab33 138
be_bryan 0:b74591d5ab33 139 output_hex_file[fib_start + 8] = (dummy_nmi_handler >> 0) & 0xFF
be_bryan 0:b74591d5ab33 140 output_hex_file[fib_start + 9] = (dummy_nmi_handler >> 8) & 0xFF
be_bryan 0:b74591d5ab33 141 output_hex_file[fib_start + 10] = (dummy_nmi_handler >> 16) & 0xFF
be_bryan 0:b74591d5ab33 142 output_hex_file[fib_start + 11] = (dummy_nmi_handler >> 24) & 0xFF
be_bryan 0:b74591d5ab33 143
be_bryan 0:b74591d5ab33 144 output_hex_file[fib_start + 12] = (dummy_hardfault_handler >> 0) & 0xFF
be_bryan 0:b74591d5ab33 145 output_hex_file[fib_start + 13] = (dummy_hardfault_handler >> 8) & 0xFF
be_bryan 0:b74591d5ab33 146 output_hex_file[fib_start + 14] = (dummy_hardfault_handler >> 16) & 0xFF
be_bryan 0:b74591d5ab33 147 output_hex_file[fib_start + 15] = (dummy_hardfault_handler >> 24) & 0xFF
be_bryan 0:b74591d5ab33 148
be_bryan 0:b74591d5ab33 149 output_hex_file[fib_start + 16] = (dummy_blank >> 0) & 0xFF
be_bryan 0:b74591d5ab33 150 output_hex_file[fib_start + 17] = (dummy_blank >> 8) & 0xFF
be_bryan 0:b74591d5ab33 151 output_hex_file[fib_start + 18] = (dummy_blank >> 16) & 0xFF
be_bryan 0:b74591d5ab33 152 output_hex_file[fib_start + 19] = (dummy_blank >> 24) & 0xFF
be_bryan 0:b74591d5ab33 153
be_bryan 0:b74591d5ab33 154 # Write FIB to the file in little endian
be_bryan 0:b74591d5ab33 155 output_hex_file[fib_start + 20] = (start >> 0) & 0xFF
be_bryan 0:b74591d5ab33 156 output_hex_file[fib_start + 21] = (start >> 8) & 0xFF
be_bryan 0:b74591d5ab33 157 output_hex_file[fib_start + 22] = (start >> 16) & 0xFF
be_bryan 0:b74591d5ab33 158 output_hex_file[fib_start + 23] = (start >> 24) & 0xFF
be_bryan 0:b74591d5ab33 159
be_bryan 0:b74591d5ab33 160 output_hex_file[fib_start + 24] = (size >> 0) & 0xFF
be_bryan 0:b74591d5ab33 161 output_hex_file[fib_start + 25] = (size >> 8) & 0xFF
be_bryan 0:b74591d5ab33 162 output_hex_file[fib_start + 26] = (size >> 16) & 0xFF
be_bryan 0:b74591d5ab33 163 output_hex_file[fib_start + 27] = (size >> 24) & 0xFF
be_bryan 0:b74591d5ab33 164
be_bryan 0:b74591d5ab33 165 output_hex_file[fib_start + 28] = (crc32 >> 0) & 0xFF
be_bryan 0:b74591d5ab33 166 output_hex_file[fib_start + 29] = (crc32 >> 8) & 0xFF
be_bryan 0:b74591d5ab33 167 output_hex_file[fib_start + 30] = (crc32 >> 16) & 0xFF
be_bryan 0:b74591d5ab33 168 output_hex_file[fib_start + 31] = (crc32 >> 24) & 0xFF
be_bryan 0:b74591d5ab33 169
be_bryan 0:b74591d5ab33 170 output_hex_file[fib_start + 32] = (fw_rev >> 0) & 0xFF
be_bryan 0:b74591d5ab33 171 output_hex_file[fib_start + 33] = (fw_rev >> 8) & 0xFF
be_bryan 0:b74591d5ab33 172 output_hex_file[fib_start + 34] = (fw_rev >> 16) & 0xFF
be_bryan 0:b74591d5ab33 173 output_hex_file[fib_start + 35] = (fw_rev >> 24) & 0xFF
be_bryan 0:b74591d5ab33 174
be_bryan 0:b74591d5ab33 175 output_hex_file[fib_start + 36] = (checksum >> 0) & 0xFF
be_bryan 0:b74591d5ab33 176 output_hex_file[fib_start + 37] = (checksum >> 8) & 0xFF
be_bryan 0:b74591d5ab33 177 output_hex_file[fib_start + 38] = (checksum >> 16) & 0xFF
be_bryan 0:b74591d5ab33 178 output_hex_file[fib_start + 39] = (checksum >> 24) & 0xFF
be_bryan 0:b74591d5ab33 179
be_bryan 0:b74591d5ab33 180 #pad the rest of the file
be_bryan 0:b74591d5ab33 181 for i in range(fib_start + dummy_fib_size + fib_size, trim_area_start):
be_bryan 0:b74591d5ab33 182 output_hex_file[i] = 0xFF
be_bryan 0:b74591d5ab33 183
be_bryan 0:b74591d5ab33 184 # Read in configuration data from the config parameter in targets.json
be_bryan 0:b74591d5ab33 185 configData = Config('NCS36510')
be_bryan 0:b74591d5ab33 186 paramData = configData.get_target_config_data()
be_bryan 0:b74591d5ab33 187 for v in paramData.values():
be_bryan 0:b74591d5ab33 188 if (v.name == "target.mac-addr-high"):
be_bryan 0:b74591d5ab33 189 mac_addr_high = int(v.value, 16)
be_bryan 0:b74591d5ab33 190 elif (v.name == "target.mac-addr-low"):
be_bryan 0:b74591d5ab33 191 mac_addr_low = int(v.value,16)
be_bryan 0:b74591d5ab33 192 elif (v.name == "target.32KHz-clk-trim"):
be_bryan 0:b74591d5ab33 193 clk_32k_trim = int(v.value,16)
be_bryan 0:b74591d5ab33 194 elif (v.name == "target.32MHz-clk-trim"):
be_bryan 0:b74591d5ab33 195 clk_32m_trim = int(v.value,16)
be_bryan 0:b74591d5ab33 196 elif (v.name == "target.rssi-trim"):
be_bryan 0:b74591d5ab33 197 rssi = int(v.value,16)
be_bryan 0:b74591d5ab33 198 elif (v.name == "target.txtune-trim"):
be_bryan 0:b74591d5ab33 199 txtune = int(v.value,16)
be_bryan 0:b74591d5ab33 200 else:
be_bryan 0:b74591d5ab33 201 print("Not a valid param")
be_bryan 0:b74591d5ab33 202
be_bryan 0:b74591d5ab33 203 output_hex_file[trim_area_start + 0] = mac_addr_low & 0xFF
be_bryan 0:b74591d5ab33 204 output_hex_file[trim_area_start + 1] = (mac_addr_low >> 8) & 0xFF
be_bryan 0:b74591d5ab33 205 output_hex_file[trim_area_start + 2] = (mac_addr_low >> 16) & 0xFF
be_bryan 0:b74591d5ab33 206 output_hex_file[trim_area_start + 3] = (mac_addr_low >> 24) & 0xFF
be_bryan 0:b74591d5ab33 207
be_bryan 0:b74591d5ab33 208 output_hex_file[trim_area_start + 4] = mac_addr_high & 0xFF
be_bryan 0:b74591d5ab33 209 output_hex_file[trim_area_start + 5] = (mac_addr_high >> 8) & 0xFF
be_bryan 0:b74591d5ab33 210 output_hex_file[trim_area_start + 6] = (mac_addr_high >> 16) & 0xFF
be_bryan 0:b74591d5ab33 211 output_hex_file[trim_area_start + 7] = (mac_addr_high >> 24) & 0xFF
be_bryan 0:b74591d5ab33 212
be_bryan 0:b74591d5ab33 213 output_hex_file[trim_area_start + 8] = clk_32k_trim & 0xFF
be_bryan 0:b74591d5ab33 214 output_hex_file[trim_area_start + 9] = (clk_32k_trim >> 8) & 0xFF
be_bryan 0:b74591d5ab33 215 output_hex_file[trim_area_start + 10] = (clk_32k_trim >> 16) & 0xFF
be_bryan 0:b74591d5ab33 216 output_hex_file[trim_area_start + 11] = (clk_32k_trim >> 24) & 0xFF
be_bryan 0:b74591d5ab33 217
be_bryan 0:b74591d5ab33 218 output_hex_file[trim_area_start + 12] = clk_32m_trim & 0xFF
be_bryan 0:b74591d5ab33 219 output_hex_file[trim_area_start + 13] = (clk_32m_trim >> 8) & 0xFF
be_bryan 0:b74591d5ab33 220 output_hex_file[trim_area_start + 14] = (clk_32m_trim >> 16) & 0xFF
be_bryan 0:b74591d5ab33 221 output_hex_file[trim_area_start + 15] = (clk_32m_trim >> 24) & 0xFF
be_bryan 0:b74591d5ab33 222
be_bryan 0:b74591d5ab33 223 output_hex_file[trim_area_start + 16] = rssi & 0xFF
be_bryan 0:b74591d5ab33 224 output_hex_file[trim_area_start + 17] = (rssi >> 8) & 0xFF
be_bryan 0:b74591d5ab33 225 output_hex_file[trim_area_start + 18] = (rssi >> 16) & 0xFF
be_bryan 0:b74591d5ab33 226 output_hex_file[trim_area_start + 19] = (rssi >> 24) & 0xFF
be_bryan 0:b74591d5ab33 227
be_bryan 0:b74591d5ab33 228 output_hex_file[trim_area_start + 20] = txtune & 0xFF
be_bryan 0:b74591d5ab33 229 output_hex_file[trim_area_start + 21] = (txtune >> 8) & 0xFF
be_bryan 0:b74591d5ab33 230 output_hex_file[trim_area_start + 22] = (txtune >> 16) & 0xFF
be_bryan 0:b74591d5ab33 231 output_hex_file[trim_area_start + 23] = (txtune >> 24) & 0xFF
be_bryan 0:b74591d5ab33 232
be_bryan 0:b74591d5ab33 233 # pad the rest of the area with 0xFF
be_bryan 0:b74591d5ab33 234 for i in range(trim_area_start + trim_size, user_code_start):
be_bryan 0:b74591d5ab33 235 output_hex_file[i] = 0xFF
be_bryan 0:b74591d5ab33 236
be_bryan 0:b74591d5ab33 237 #merge two hex files
be_bryan 0:b74591d5ab33 238 output_hex_file.merge(input_hex_file, overlap='error')
be_bryan 0:b74591d5ab33 239
be_bryan 0:b74591d5ab33 240 # Write out file(s)
be_bryan 0:b74591d5ab33 241 output_hex_file.tofile(file_name_hex, 'hex')