mirror of
				https://xff.cz/git/u-boot/
				synced 2025-10-31 18:35:42 +01:00 
			
		
		
		
	lib: sparse: Make CHUNK_TYPE_RAW buffer aligned
CHUNK_TYPE_RAW buffer is not aligned, and flash sparse images by fastboot will report "Misaligned operation" if DCACHE is enabled. Flashing Sparse Image CACHE: Misaligned operation at range [84000028, 84001028] CACHE: Misaligned operation at range [84001034, 84002034] CACHE: Misaligned operation at range [8401104c, 8401304c] Fix it Signed-off-by: qianfan Zhao <qianfanguijin@163.com> Reviewed-by: Sean Anderson <sean.anderson@seco.com>
This commit is contained in:
		| @@ -46,9 +46,66 @@ | |||||||
| #include <asm/cache.h> | #include <asm/cache.h> | ||||||
|  |  | ||||||
| #include <linux/math64.h> | #include <linux/math64.h> | ||||||
|  | #include <linux/err.h> | ||||||
|  |  | ||||||
| static void default_log(const char *ignored, char *response) {} | static void default_log(const char *ignored, char *response) {} | ||||||
|  |  | ||||||
|  | static lbaint_t write_sparse_chunk_raw(struct sparse_storage *info, | ||||||
|  | 				       lbaint_t blk, lbaint_t blkcnt, | ||||||
|  | 				       void *data, | ||||||
|  | 				       char *response) | ||||||
|  | { | ||||||
|  | 	lbaint_t n = blkcnt, write_blks, blks = 0, aligned_buf_blks = 100; | ||||||
|  | 	uint32_t *aligned_buf = NULL; | ||||||
|  |  | ||||||
|  | 	if (CONFIG_IS_ENABLED(SYS_DCACHE_OFF)) { | ||||||
|  | 		write_blks = info->write(info, blk, n, data); | ||||||
|  | 		if (write_blks < n) | ||||||
|  | 			goto write_fail; | ||||||
|  |  | ||||||
|  | 		return write_blks; | ||||||
|  | 	} | ||||||
|  |  | ||||||
|  | 	aligned_buf = memalign(ARCH_DMA_MINALIGN, info->blksz * aligned_buf_blks); | ||||||
|  | 	if (!aligned_buf) { | ||||||
|  | 		info->mssg("Malloc failed for: CHUNK_TYPE_RAW", response); | ||||||
|  | 		return -ENOMEM; | ||||||
|  | 	} | ||||||
|  |  | ||||||
|  | 	while (blkcnt > 0) { | ||||||
|  | 		n = min(aligned_buf_blks, blkcnt); | ||||||
|  | 		memcpy(aligned_buf, data, n * info->blksz); | ||||||
|  |  | ||||||
|  | 		/* write_blks might be > n due to NAND bad-blocks */ | ||||||
|  | 		write_blks = info->write(info, blk + blks, n, aligned_buf); | ||||||
|  | 		if (write_blks < n) { | ||||||
|  | 			free(aligned_buf); | ||||||
|  | 			goto write_fail; | ||||||
|  | 		} | ||||||
|  |  | ||||||
|  | 		blks += write_blks; | ||||||
|  | 		data += n * info->blksz; | ||||||
|  | 		blkcnt -= n; | ||||||
|  | 	} | ||||||
|  |  | ||||||
|  | 	free(aligned_buf); | ||||||
|  | 	return blks; | ||||||
|  |  | ||||||
|  | write_fail: | ||||||
|  | 	if (IS_ERR_VALUE(write_blks)) { | ||||||
|  | 		printf("%s: Write failed, block #" LBAFU " [" LBAFU "] (%lld)\n", | ||||||
|  | 		       __func__, blk + blks, n, (long long)write_blks); | ||||||
|  | 		info->mssg("flash write failure", response); | ||||||
|  | 		return write_blks; | ||||||
|  | 	} | ||||||
|  |  | ||||||
|  | 	/* write_blks < n */ | ||||||
|  | 	printf("%s: Write failed, block #" LBAFU " [" LBAFU "]\n", | ||||||
|  | 	       __func__, blk + blks, n); | ||||||
|  | 	info->mssg("flash write failure(incomplete)", response); | ||||||
|  | 	return -1; | ||||||
|  | } | ||||||
|  |  | ||||||
| int write_sparse_image(struct sparse_storage *info, | int write_sparse_image(struct sparse_storage *info, | ||||||
| 		       const char *part_name, void *data, char *response) | 		       const char *part_name, void *data, char *response) | ||||||
| { | { | ||||||
| @@ -152,15 +209,11 @@ int write_sparse_image(struct sparse_storage *info, | |||||||
| 				return -1; | 				return -1; | ||||||
| 			} | 			} | ||||||
|  |  | ||||||
| 			blks = info->write(info, blk, blkcnt, data); | 			blks = write_sparse_chunk_raw(info, blk, blkcnt, | ||||||
| 			/* blks might be > blkcnt (eg. NAND bad-blocks) */ | 						      data, response); | ||||||
| 			if (blks < blkcnt) { | 			if (blks < 0) | ||||||
| 				printf("%s: %s" LBAFU " [" LBAFU "]\n", |  | ||||||
| 				       __func__, "Write failed, block #", |  | ||||||
| 				       blk, blks); |  | ||||||
| 				info->mssg("flash write failure", response); |  | ||||||
| 				return -1; | 				return -1; | ||||||
| 			} |  | ||||||
| 			blk += blks; | 			blk += blks; | ||||||
| 			bytes_written += ((u64)blkcnt) * info->blksz; | 			bytes_written += ((u64)blkcnt) * info->blksz; | ||||||
| 			total_blocks += chunk_header->chunk_sz; | 			total_blocks += chunk_header->chunk_sz; | ||||||
|   | |||||||
		Reference in New Issue
	
	Block a user