Prepare sectors before write

Prepare sectors just before write when copying from RAM.

lpc.c

@@ -94,6 +94,8 @@ void lpc_init(struct lpc_device *dev) {
 void lpc_write(struct lpc_device *dev, const struct sprog_data *d) {
   static const int chunk_sizes[] = {256, 512, 1024, 4096, 0}; /* keep it sorted! */
   struct sprog_data chunk;
+  int sect_start;
+  int sect_end;
   int i;
   int j;
   int status;
@@ -107,24 +109,18 @@ void lpc_write(struct lpc_device *dev, const struct sprog_data *d) {
   
   lpc_command(dev, "U 23130\r\n"); /* unlock the device */
   
-  i = dev->part->flash/4 - 1; /* last sector = Flash size / 4kB - 1 */
-  lpc_command(dev, "P 0 %d\r\n", i);
+  sect_end = dev->part->flash/4 - 1; /* last sector = Flash size / 4kB - 1 */
+  lpc_command(dev, "P 0 %d\r\n", sect_end);
   
   sprog_info("Erasing Flash memory... ");
   j = dev->reply_time;
   dev->reply_time = 5000;
-  if(lpc_command(dev, "E 0 %d\r\n", i))
+  if(lpc_command(dev, "E 0 %d\r\n", sect_end))
     sprog_info("Error\n");
   else
     sprog_info("OK\n");
   dev->reply_time = j;
   
-  i = d->size/4096 - 1;
-  if(d->size % 4096)
-    i++;
-  
-  lpc_command(dev, "P 0 %d\r\n", i); /* prepare sectors for write */
-  
   while(d->size-offset>0) {
     chunk_size = d->size - offset;
     for(i=0; chunk_sizes[i]; i++) {
@@ -186,7 +182,11 @@ void lpc_write(struct lpc_device *dev, const struct sprog_data *d) {
       for(j=j; j>=0; j--)
 	if(chunk_sizes[j]<=i)
 	  break;
-      sprog_info("Copy from 0x%08x to %d (%d bytes)\n", 0x10000400+(chunk_size-i), offset+(chunk_size-i), chunk_sizes[j]);
+	
+      sect_start = offset/4096;
+      sect_end = (offset+chunk_sizes[j])/4096;
+      
+      lpc_command(dev, "P %d %d\r\n", sect_start, sect_end); /* prepare sectors for write */
       if(lpc_command(dev, "C %d %u %d\r\n", offset+(chunk_size-i), 0x10000400+(chunk_size-i), chunk_sizes[j]))
 	status = 0;
     }