X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fkernel%2Fao_storage.c;h=cfd116f9791bc536ae2e5709ddc066a3d84f3d8e;hb=HEAD;hp=ca5fcb464d9129508098394870b2568bdb724be9;hpb=b08a793fb6e6167d635bfbd31605a43db1f5ac5d;p=fw%2Faltos

diff --git a/src/kernel/ao_storage.c b/src/kernel/ao_storage.c
index ca5fcb46..a2c3738d 100644
--- a/src/kernel/ao_storage.c
+++ b/src/kernel/ao_storage.c
@@ -22,6 +22,7 @@
 #define AO_STORAGE_DATA_SIZE	128
 
 static uint8_t storage_data[AO_STORAGE_DATA_SIZE];
+static uint8_t storage_mutex;
 
 uint8_t
 ao_storage_read(ao_pos_t pos, void *v_buf, uint16_t len)
@@ -38,7 +39,7 @@ ao_storage_read(ao_pos_t pos, void *v_buf, uint16_t len)
 		/* Compute portion of transfer within
 		 * a single block
 		 */
-		this_off = (uint16_t) pos & (ao_storage_unit - 1);
+		this_off = (uint16_t) (pos & (ao_storage_unit - 1));
 		this_len = ao_storage_unit - this_off;
 		if (this_len > len)
 			this_len = len;
@@ -69,7 +70,7 @@ ao_storage_write(ao_pos_t pos, void *v_buf, uint16_t len)
 		/* Compute portion of transfer within
 		 * a single block
 		 */
-		this_off = (uint16_t) pos & (ao_storage_unit - 1);
+		this_off = (uint16_t) (pos & (ao_storage_unit - 1));
 		this_len = ao_storage_unit - this_off;
 		if (this_len > len)
 			this_len = len;
@@ -91,22 +92,31 @@ ao_storage_is_erased(uint32_t pos)
 	uint32_t	read_pos;
 	uint32_t	read_len;
 	uint32_t	i;
+	uint8_t		ret = 1;
 
+	ao_storage_setup();
+	ao_mutex_get(&storage_mutex);
 	read_pos = pos;
 	read_len = ao_storage_block;
 	while (read_len) {
 		uint32_t this_time = AO_STORAGE_DATA_SIZE;
 		if (this_time > read_len)
 			this_time = read_len;
-		if (!ao_storage_read(read_pos, storage_data, this_time))
-			return 0;
+		if (!ao_storage_read(read_pos, storage_data, (uint16_t) this_time)) {
+			ret = 0;
+			goto done;
+		}
 		for (i = 0; i < this_time; i++)
-			if (storage_data[i] != 0xff)
-				return 0;
+			if (storage_data[i] != AO_STORAGE_ERASED_BYTE) {
+				ret = 0;
+				goto done;
+			}
 		read_pos += this_time;
 		read_len -= this_time;
 	}
-	return 1;
+done:
+	ao_mutex_put(&storage_mutex);
+	return ret;
 }
 
 uint8_t
@@ -144,25 +154,29 @@ static void
 ao_storage_dump(void) 
 {
 	uint32_t block;
-	uint8_t i, j;
+	uint8_t i, j, k;
 
 	block = ao_cmd_hex();
 	if (ao_cmd_status != ao_cmd_success)
 		return;
-	for (i = 0; ; i += 8) {
+	ao_mutex_get(&storage_mutex);
+	for (i = 0; ; i += AO_STORAGE_DATA_SIZE) {
 		if (ao_storage_read((block << 8) + i,
 				    storage_data,
-				    8)) {
-			ao_cmd_put16((uint16_t) i);
-			for (j = 0; j < 8; j++) {
-				putchar(' ');
-				ao_cmd_put8(storage_data[j]);
+				    AO_STORAGE_DATA_SIZE)) {
+			for (k = 0; k < AO_STORAGE_DATA_SIZE; k += 8) {
+				ao_cmd_put16((uint16_t) i + k);
+				for (j = 0; j < 8; j++) {
+					putchar(' ');
+					ao_cmd_put8(storage_data[k + j]);
+				}
+				putchar ('\n');
 			}
-			putchar ('\n');
 		}
-		if (i == 248)
+		if (i == 256 - AO_STORAGE_DATA_SIZE)
 			break;
 	}
+	ao_mutex_put(&storage_mutex);
 }
 
 #if HAS_STORAGE_DEBUG