X-Git-Url: http://git.rot13.org/?a=blobdiff_plain;f=src%2Ftarget%2Ffirmware%2Fcalypso%2Fdsp.c;h=0d9521f0adbf4ba5de5197528f181bd254fce6d6;hb=59bc439886ca96c841a3dfaea0f31d0c5e0e7500;hp=2ce0bc7d2f65f20e83c7c23379bc9b25f4188a14;hpb=379608d218e053c4de1502b3c8b0be83f17a277e;p=osmocom-bb.git

diff --git a/src/target/firmware/calypso/dsp.c b/src/target/firmware/calypso/dsp.c
index 2ce0bc7..0d9521f 100644
--- a/src/target/firmware/calypso/dsp.c
+++ b/src/target/firmware/calypso/dsp.c
@@ -116,6 +116,41 @@ static void dsp_bl_start_at(uint16_t addr)
 	writew(BL_CMD_COPY_BLOCK, BL_CMD_STATUS);
 }
 
+static int dsp_bl_upload_sections(const struct dsp_section *sec)
+{
+	/* Make sure the bootloader is ready */
+	dsp_bl_wait_ready();
+
+	/* Set mode */
+	writew(BL_MODE_DATA_WRITE, BASE_API_RAM);
+	writew(BL_CMD_COPY_MODE, BL_CMD_STATUS);
+	dsp_bl_wait_ready();
+
+	/* Scan all sections */
+	for (; sec->data; sec++) {
+		volatile uint16_t *api = (volatile uint16_t *)BASE_API_RAM;
+		unsigned int i;
+
+		if (sec->size > BL_MAX_BLOCK_SIZE)
+			return -1; /* not supported for now */
+
+		/* Copy data to API */
+		for (i=0; i<sec->size; i++)
+			api[i] = sec->data[i];
+
+		/* Issue DRAM write */
+		writew(sec->addr >> 16, BL_ADDR_HI);
+		writew(sec->addr & 0xffff, BL_ADDR_LO);
+		writew(sec->size, BL_SIZE);
+		writew(BL_CMD_COPY_BLOCK, BL_CMD_STATUS);
+
+		/* Wait for completion */
+		dsp_bl_wait_ready();
+	}
+
+	return 0;
+}
+
 static int dsp_upload_sections_api(const struct dsp_section *sec, uint16_t dsp_base_api)
 {
 	for (; sec->data; sec++) {