3 files changed, 147 insertions, 130 deletions

diff --git a/apps/plugins/lib/gray.h b/apps/plugins/lib/gray.h
index f1007984b5..dadac9298f 100644
--- a/apps/plugins/lib/gray.h
+++ b/apps/plugins/lib/gray.h
@@ -42,7 +42,6 @@ void gray_release(void);
 /* Special functions */
 void gray_show(bool enable);
 void gray_deferred_lcd_update(void);
-void gray_screendump(void);
 
 /* Update functions */
 void gray_update(void);
diff --git a/apps/plugins/lib/gray_core.c b/apps/plugins/lib/gray_core.c
index ecff53f1c5..02477b5b82 100644
--- a/apps/plugins/lib/gray_core.c
+++ b/apps/plugins/lib/gray_core.c
@@ -36,6 +36,7 @@ short _gray_random_buffer;          /* buffer for random number generator */
 
 /* Prototypes */
 static void _timer_isr(void);
+static void gray_screendump_hook(int fd);
 
 /* Timer interrupt handler: display next bitplane */
 static void _timer_isr(void)
@@ -230,11 +231,13 @@ void gray_show(bool enable)
     {
         _gray_info.flags |= _GRAY_RUNNING;
         _gray_rb->timer_register(1, NULL, FREQ / 67, 1, _timer_isr);
+        _gray_rb->screen_dump_set_hook(gray_screendump_hook);
     }
     else
     {
         _gray_rb->timer_unregister();
         _gray_info.flags &= ~_GRAY_RUNNING;
+        _gray_rb->screen_dump_set_hook(NULL);
         _gray_rb->lcd_update(); /* restore whatever there was before */
     }
 #elif defined(CPU_COLDFIRE) && (CONFIG_LCD == LCD_S1D15E06)
@@ -244,12 +247,14 @@ void gray_show(bool enable)
         _gray_rb->cpu_boost(true);  /* run at 120 MHz to avoid freq changes */
         _gray_rb->timer_register(1, NULL, *_gray_rb->cpu_frequency / 70, 1,
                                  _timer_isr);
+        _gray_rb->screen_dump_set_hook(gray_screendump_hook);
     }
     else if (!enable && (_gray_info.flags & _GRAY_RUNNING))
     {
         _gray_rb->timer_unregister();
         _gray_rb->cpu_boost(false);
         _gray_info.flags &= ~_GRAY_RUNNING;
+        _gray_rb->screen_dump_set_hook(NULL);
         _gray_rb->lcd_update(); /* restore whatever there was before */
     }
 #endif
@@ -315,7 +320,7 @@ void gray_update_rect(int x, int y, int width, int height)
             if (change != 0)
             {
                 unsigned char *addr, *end;
-                unsigned mask;
+                unsigned mask, trash;
 
                 pat_ptr = &pat_stack[8];
                 cbuf = _gray_info.cur_buffer + srcofs_row;
@@ -400,7 +405,7 @@ void gray_update_rect(int x, int y, int width, int height)
                     "mov.l   @%[patp]+,r7\n"
                     "mov.l   @%[patp]+,r8\n"
                     "mov.l   @%[patp]+,r9\n"
-                    "mov.l   @%[patp]+,r10   \n"
+                    "mov.l   @%[patp],%[rx]  \n"
 
                     "tst     %[mask],%[mask] \n"  /* nothing to keep? */
                     "bt      .ur_sloop   \n"  /* yes: jump to short loop */
@@ -420,7 +425,7 @@ void gray_update_rect(int x, int y, int width, int height)
                     "rotcl   r0          \n"
                     "shlr    r9          \n"
                     "rotcl   r0          \n"
-                    "shlr    r10         \n"
+                    "shlr    %[rx]       \n"
                     "mov.b   @%[addr],%[patp]\n"  /* read old value */
                     "rotcl   r0          \n"
                     "and     %[mask],%[patp] \n"  /* mask out unneeded bits */
@@ -448,7 +453,7 @@ void gray_update_rect(int x, int y, int width, int height)
                     "rotcl   r0          \n"
                     "shlr    r9          \n"
                     "rotcl   r0          \n"
-                    "shlr    r10         \n"
+                    "shlr    %[rx]       \n"
                     "rotcl   r0          \n"
                     "mov.b   r0,@%[addr]     \n"  /* store byte to bitplane */
                     "add     %[psiz],%[addr] \n"  /* advance to next bitplane */
@@ -457,14 +462,15 @@ void gray_update_rect(int x, int y, int width, int height)
 
                 ".ur_end:                \n"
                     : /* outputs */
-                    [patp]"+r"(pat_ptr),
                     [addr]"+r"(addr),
-                    [mask]"+r"(mask)
+                    [mask]"+r"(mask),
+                    [rx]  "=&r"(trash)
                     : /* inputs */
+                    [psiz]"r"(_gray_info.plane_size),
                     [end] "r"(end),
-                    [psiz]"r"(_gray_info.plane_size)
+                    [patp]"[rx]"(pat_ptr)
                     : /* clobbers */
-                    "r0", "r1", "r2", "r3", "r6", "r7", "r8", "r9", "r10"
+                    "r0", "r1", "r2", "r3", "r6", "r7", "r8", "r9"
                 );
             }
 #elif defined(CPU_COLDFIRE) && (LCD_DEPTH == 2)
@@ -496,7 +502,7 @@ void gray_update_rect(int x, int y, int width, int height)
             if (change != 0)
             {
                 unsigned char *addr, *end;
-                unsigned mask;
+                unsigned mask, trash;
 
                 pat_ptr = &pat_stack[8];
                 cbuf = _gray_info.cur_buffer + srcofs_row;
@@ -567,7 +573,7 @@ void gray_update_rect(int x, int y, int width, int height)
                 /* set the bits for all 8 pixels in all bytes according to the
                  * precalculated patterns on the pattern stack */
                 asm volatile (
-                    "movem.l (%[patp]),%%d2-%%d6/%%a0-%%a2   \n" 
+                    "movem.l (%[patp]),%%d2-%%d6/%%a0-%%a1/%[ax] \n" 
                                               /* pop all 8 patterns */
                     "not.l   %[mask]     \n"  /* set mask -> keep mask */
                     "and.l   #0xFF,%[mask]   \n"
@@ -593,10 +599,10 @@ void gray_update_rect(int x, int y, int width, int height)
                     "lsr.l   #1,%%d1     \n"
                     "addx.l  %%d0,%%d0   \n"
                     "move.l  %%d1,%%a1   \n"
-                    "move.l  %%a2,%%d1   \n"
+                    "move.l  %[ax],%%d1  \n"
                     "lsr.l   #1,%%d1     \n"
                     "addx.l  %%d0,%%d0   \n"
-                    "move.l  %%d1,%%a2   \n"
+                    "move.l  %%d1,%[ax]  \n"
 
                     "move.b  (%[addr]),%%d1  \n"  /* read old value */
                     "and.l   %[mask],%%d1    \n"  /* mask out unneeded bits */
@@ -629,10 +635,10 @@ void gray_update_rect(int x, int y, int width, int height)
                     "lsr.l   #1,%%d1     \n"
                     "addx.l  %%d0,%%d0   \n"
                     "move.l  %%d1,%%a1   \n"
-                    "move.l  %%a2,%%d1   \n"
+                    "move.l  %[ax],%%d1  \n"
                     "lsr.l   #1,%%d1     \n"
                     "addx.l  %%d0,%%d0   \n"
-                    "move.l  %%d1,%%a2   \n"
+                    "move.l  %%d1,%[ax]  \n"
 
                     "move.b  %%d0,(%[addr])  \n"  /* store byte to bitplane */
                     "add.l   %[psiz],%[addr] \n"  /* advance to next bitplane */
@@ -642,13 +648,14 @@ void gray_update_rect(int x, int y, int width, int height)
                 ".ur_end:                \n"
                     : /* outputs */
                     [addr]"+a"(addr),
-                    [mask]"+d"(mask)
+                    [mask]"+d"(mask),
+                    [ax]  "=&a"(trash)
                     : /* inputs */
                     [psiz]"a"(_gray_info.plane_size),
                     [end] "a"(end),
-                    [patp]"a"(pat_ptr)
+                    [patp]"[ax]"(pat_ptr)
                     : /* clobbers */
-                    "d0", "d1", "d2", "d3", "d4", "d5", "d6", "a0", "a1", "a2"
+                    "d0", "d1", "d2", "d3", "d4", "d5", "d6", "a0", "a1"
                 );
             }
 #endif
@@ -692,12 +699,14 @@ void gray_deferred_lcd_update(void)
 
 /*** Screenshot ***/
 
-#define BMP_NUMCOLORS  33
-#define BMP_BPP        8
-#define BMP_LINESIZE   ((LCD_WIDTH + 3) & ~3)
-#define BMP_HEADERSIZE (54 + 4 * BMP_NUMCOLORS)
-#define BMP_DATASIZE   (BMP_LINESIZE * LCD_HEIGHT)
-#define BMP_TOTALSIZE  (BMP_HEADERSIZE + BMP_DATASIZE)
+#define BMP_FIXEDCOLORS (1 << LCD_DEPTH)
+#define BMP_VARCOLORS   33
+#define BMP_NUMCOLORS   (BMP_FIXEDCOLORS + BMP_VARCOLORS)
+#define BMP_BPP         8
+#define BMP_LINESIZE    ((LCD_WIDTH + 3) & ~3)
+#define BMP_HEADERSIZE  (54 + 4 * BMP_NUMCOLORS)
+#define BMP_DATASIZE    (BMP_LINESIZE * LCD_HEIGHT)
+#define BMP_TOTALSIZE   (BMP_HEADERSIZE + BMP_DATASIZE)
 
 #define LE16_CONST(x) (x)&0xff, ((x)>>8)&0xff
 #define LE32_CONST(x) (x)&0xff, ((x)>>8)&0xff, ((x)>>16)&0xff, ((x)>>24)&0xff
@@ -720,6 +729,17 @@ static const unsigned char bmpheader[] =
     0xc4, 0x0e, 0x00, 0x00,     /* Vertical resolution (pixels/meter) */
     LE32_CONST(BMP_NUMCOLORS),  /* Number of used colours */
     LE32_CONST(BMP_NUMCOLORS),  /* Number of important colours */
+
+    /* Fixed colours */
+#if LCD_DEPTH == 1
+    0x90, 0xee, 0x90, 0x00,     /* Colour #0 */
+    0x00, 0x00, 0x00, 0x00      /* Colour #1 */
+#elif LCD_DEPTH == 2
+    0xe6, 0xd8, 0xad, 0x00,     /* Colour #0 */
+    0x99, 0x90, 0x73, 0x00,     /* Colour #1 */
+    0x4c, 0x48, 0x39, 0x00,     /* Colour #2 */
+    0x00, 0x00, 0x00, 0x00      /* Colour #3 */
+#endif
 };
 
 #if LCD_DEPTH == 1
@@ -732,135 +752,131 @@ static const unsigned char bmpheader[] =
 #define BMP_BLUE  0xe6
 #endif
 
-static unsigned char linebuf[BMP_LINESIZE];
-
-/* Save the current display content (b&w and greyscale overlay) to an 8-bit
- * BMP file in the root directory. */
-void gray_screendump(void)
+/* Hook function for core screen_dump() to save the current display
+   content (b&w and greyscale overlay) to an 8-bit BMP file. */
+static void gray_screendump_hook(int fd)
 {
-    int fh, i, bright;
-    int y;
+    int i, idx;
+    int x, y, by;
+    int gx, mask;
 #if LCD_DEPTH == 1
-    int x, by, mask;
-    int gx, gby;
-    unsigned char *lcdptr, *grayptr, *grayptr2;
-#endif
-    char filename[MAX_PATH];
-
-#ifdef HAVE_RTC
-    struct tm *tm = _gray_rb->get_time();
-
-    _gray_rb->snprintf(filename, MAX_PATH,
-                       "/graydump %04d-%02d-%02d %02d-%02d-%02d.bmp",
-                       tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday,
-                       tm->tm_hour, tm->tm_min, tm->tm_sec);
-#else
-    {
-        DIR* dir;
-        int max_dump_file = 1; /* default to graydump_0001.bmp */
-        dir = _gray_rb->opendir("/");
-        if (dir) /* found */
-        {
-            /* Search for the highest screendump filename present,
-               increment behind that. So even with "holes"
-               (deleted files), the newest will always have the
-               highest number. */
-            while(true)
-            {   
-                struct dirent* entry;
-                int curr_dump_file;
-                /* walk through the directory content */
-                entry = _gray_rb->readdir(dir);
-                if (!entry)
-                {
-                    _gray_rb->closedir(dir);
-                    break; /* end of dir */
-                }
-                if (_gray_rb->strncasecmp(entry->d_name, "graydump_", 9))
-                    continue; /* no screendump file */
-                curr_dump_file = _gray_rb->atoi(&entry->d_name[9]);
-                if (curr_dump_file >= max_dump_file)
-                    max_dump_file = curr_dump_file + 1;
-            }
-        }
-        _gray_rb->snprintf(filename, MAX_PATH, "/graydump_%04d.bmp",
-                           max_dump_file);
-    }
+    int gby;
+#elif LCD_DEPTH == 2
+    int shift, gy;
 #endif
+    unsigned char *clut_entry;
+    unsigned char *lcdptr;
+    unsigned char *grayptr, *grayptr2;
+    unsigned char linebuf[MAX(4*BMP_VARCOLORS,BMP_LINESIZE)];
 
-    fh = _gray_rb->creat(filename, O_WRONLY);
-
-    if (fh < 0)
-        return;
-        
-    _gray_rb->write(fh, bmpheader, sizeof(bmpheader));  /* write header */
+    _gray_rb->write(fd, bmpheader, sizeof(bmpheader));  /* write header */
 
     /* build clut */
-    linebuf[3] = 0;
+    _gray_rb->memset(linebuf, 0, 4*BMP_VARCOLORS);
+    clut_entry = linebuf;
 
-    for (i = 0; i < BMP_NUMCOLORS; i++)
+    for (i = _gray_info.depth; i > 0; i--)
     {
-        bright = MIN(i, _gray_info.depth);
-        linebuf[0] = MULU16(BMP_BLUE,  bright) / _gray_info.depth;
-        linebuf[1] = MULU16(BMP_GREEN, bright) / _gray_info.depth;
-        linebuf[2] = MULU16(BMP_RED,   bright) / _gray_info.depth;
-        _gray_rb->write(fh, linebuf, 4);
+        *clut_entry++ = MULU16(BMP_BLUE,  i) / _gray_info.depth;
+        *clut_entry++ = MULU16(BMP_GREEN, i) / _gray_info.depth;
+        *clut_entry++ = MULU16(BMP_RED,   i) / _gray_info.depth;
+        clut_entry++;
     }
+    _gray_rb->write(fd, linebuf, 4*BMP_VARCOLORS);
 
-    /* 8-bit BMP image goes bottom -> top */
+    /* BMP image goes bottom -> top */
     for (y = LCD_HEIGHT - 1; y >= 0; y--)
     {
-        _gray_rb->memset(linebuf, BMP_NUMCOLORS-1, LCD_WIDTH);
+        _gray_rb->memset(linebuf, 0, BMP_LINESIZE);
 
 #if LCD_DEPTH == 1
-        mask = 1 << (y & 7);
-        by = y >> 3;
+        mask = 1 << (y & (_PBLOCK-1));
+        by = y >> _PBLOCK_EXP;
         lcdptr = _gray_rb->lcd_framebuffer + MULU16(LCD_WIDTH, by);
         gby = by - _gray_info.by;
 
-        if ((_gray_info.flags & _GRAY_RUNNING)
-            && (unsigned) gby < (unsigned) _gray_info.bheight)
-        {   
+        if ((unsigned) gby < (unsigned) _gray_info.bheight)
+        {
             /* line contains greyscale (and maybe b&w) graphics */
             grayptr = _gray_info.plane_data + MULU16(_gray_info.width, gby);
 
             for (x = 0; x < LCD_WIDTH; x++)
             {
-                if (*lcdptr++ & mask)
-                    linebuf[x] = 0;
-            
                 gx = x - _gray_info.x;
                 
                 if ((unsigned)gx < (unsigned)_gray_info.width)
                 {
-                    bright = 0;
+                    idx = BMP_FIXEDCOLORS;
                     grayptr2 = grayptr + gx;
 
-                    for (i = 0; i < _gray_info.depth; i++)
+                    for (i = _gray_info.depth; i > 0; i--)
                     {
-                        if (!(*grayptr2 & mask))
-                            bright++;
+                        if (*grayptr2 & mask)
+                            idx++;
                         grayptr2 += _gray_info.plane_size;
                     }
-                    linebuf[x] = bright;
+                    linebuf[x] = idx;
+                }
+                else
+                {
+                    linebuf[x] = (*lcdptr & mask) ? 1 : 0;
                 }
+                lcdptr++;
             }
         }
-        else  
-        {   
+        else
+        {
             /* line contains only b&w graphics */
             for (x = 0; x < LCD_WIDTH; x++)
-                if (*lcdptr++ & mask)
-                    linebuf[x] = 0;
+                linebuf[x] = (*lcdptr++ & mask) ? 1 : 0;
         }
 #elif LCD_DEPTH == 2
-        /* TODO */
+        shift = 2 * (y & 3);
+        by = y >> 2;
+        lcdptr = _gray_rb->lcd_framebuffer + MULU16(LCD_WIDTH, by);
+        gy = y - (_gray_info.by << _PBLOCK_EXP);
+        
+        if ((unsigned)gy < (unsigned)_gray_info.height)
+        {
+            /* line contains greyscale (and maybe b&w) graphics */
+            mask = 1 << (gy & (_PBLOCK-1));
+            grayptr = _gray_info.plane_data 
+                    + MULU16(_gray_info.width, gy >> _PBLOCK_EXP);
+
+            for (x = 0; x < LCD_WIDTH; x++)
+            {
+                gx = x - _gray_info.x;
+                
+                if ((unsigned)gx < (unsigned)_gray_info.width)
+                {
+                    idx = BMP_FIXEDCOLORS;
+                    grayptr2 = grayptr + gx;
+
+                    for (i = _gray_info.depth; i > 0; i--)
+                    {
+                        if (*grayptr2 & mask)
+                            idx++;
+                        grayptr2 += _gray_info.plane_size;
+                    }
+                    linebuf[x] = idx;
+                }
+                else
+                {
+                    linebuf[x] = (*lcdptr >> shift) & 3;
+                }
+                lcdptr++;
+            }
+        }
+        else
+        {
+            /* line contains only b&w graphics */
+            for (x = 0; x < LCD_WIDTH; x++)
+                linebuf[x] = (*lcdptr++ >> shift) & 3;
+        }
 #endif
 
-        _gray_rb->write(fh, linebuf, sizeof(linebuf));
+        _gray_rb->write(fd, linebuf, BMP_LINESIZE);
     }
-
-    _gray_rb->close(fh);
 }
 
 #endif /* HAVE_LCD_BITMAP */
diff --git a/apps/plugins/lib/gray_draw.c b/apps/plugins/lib/gray_draw.c
index 4b2237197c..d03f450b5f 100644
--- a/apps/plugins/lib/gray_draw.c
+++ b/apps/plugins/lib/gray_draw.c
@@ -588,7 +588,7 @@ static void _writearray(unsigned char *address, const unsigned char *src,
     unsigned long *pat_ptr = &pat_stack[8];
     const unsigned char *_src;
     unsigned char *addr, *end;
-    unsigned _mask;
+    unsigned _mask, trash;
 
     _mask = mask;
     _src = src;
@@ -675,7 +675,7 @@ static void _writearray(unsigned char *address, const unsigned char *src,
         "mov.l   @%[patp]+,r7\n"
         "mov.l   @%[patp]+,r8\n"
         "mov.l   @%[patp]+,r9\n"
-        "mov.l   @%[patp]+,r10   \n"
+        "mov.l   @%[patp],%[rx]  \n"
 
         "not     %[mask],%[mask] \n"  /* "set" mask -> "keep" mask */
         "extu.b  %[mask],%[mask] \n"  /* mask out high bits */
@@ -697,7 +697,7 @@ static void _writearray(unsigned char *address, const unsigned char *src,
         "rotcl   r0          \n"
         "shlr    r9          \n"
         "rotcl   r0          \n"
-        "shlr    r10         \n"
+        "shlr    %[rx]       \n"
         "mov.b   @%[addr],%[patp]\n"  /* read old value */
         "rotcl   r0          \n"
         "and     %[mask],%[patp] \n"  /* mask out unneeded bits */
@@ -725,7 +725,7 @@ static void _writearray(unsigned char *address, const unsigned char *src,
         "rotcl   r0          \n"
         "shlr    r9          \n"
         "rotcl   r0          \n"
-        "shlr    r10         \n"
+        "shlr    %[rx]       \n"
         "rotcl   r0          \n"
         "mov.b   r0,@%[addr] \n"  /* store byte to bitplane */
         "add     %[psiz],%[addr] \n"  /* advance to next bitplane */
@@ -734,21 +734,22 @@ static void _writearray(unsigned char *address, const unsigned char *src,
 
     ".wa_end:                \n"
         : /* outputs */
-        [patp]"+r"(pat_ptr),
         [addr]"+r"(addr),
-        [mask]"+r"(_mask)
+        [mask]"+r"(_mask),
+        [rx]  "=&r"(trash)
         : /* inputs */
+        [psiz]"r"(_gray_info.plane_size),
         [end] "r"(end),
-        [psiz]"r"(_gray_info.plane_size)
+        [patp]"[rx]"(pat_ptr)
         : /* clobbers */
-        "r0", "r1", "r2", "r3", "r6", "r7", "r8", "r9", "r10"
+        "r0", "r1", "r2", "r3", "r6", "r7", "r8", "r9"
     );
 #elif defined(CPU_COLDFIRE) && (LCD_DEPTH == 2)
     unsigned long pat_stack[8];
     unsigned long *pat_ptr = &pat_stack[8];
     const unsigned char *_src;
     unsigned char *addr, *end;
-    unsigned _mask;
+    unsigned _mask, trash;
 
     _mask = mask;
     _src = src;
@@ -819,8 +820,8 @@ static void _writearray(unsigned char *address, const unsigned char *src,
     /* set the bits for all 8 pixels in all bytes according to the
      * precalculated patterns on the pattern stack */
     asm volatile (
-        "movem.l (%[patp]),%%d2-%%d6/%%a0-%%a2   \n"  /* pop all 8 patterns */
-
+        "movem.l (%[patp]),%%d2-%%d6/%%a0-%%a1/%[ax] \n"  
+                                  /* pop all 8 patterns */
         "not.l   %[mask]     \n"  /* "set" mask -> "keep" mask */
         "and.l   #0xFF,%[mask]   \n"
         "beq.b   .wa_sloop   \n"  /* yes: jump to short loop */
@@ -845,10 +846,10 @@ static void _writearray(unsigned char *address, const unsigned char *src,
         "lsr.l   #1,%%d1     \n"
         "addx.l  %%d0,%%d0   \n"
         "move.l  %%d1,%%a1   \n"
-        "move.l  %%a2,%%d1   \n"
+        "move.l  %[ax],%%d1  \n"
         "lsr.l   #1,%%d1     \n"
         "addx.l  %%d0,%%d0   \n"
-        "move.l  %%d1,%%a2   \n"
+        "move.l  %%d1,%[ax]  \n"
 
         "move.b  (%[addr]),%%d1  \n"  /* read old value */
         "and.l   %[mask],%%d1    \n"  /* mask out unneeded bits */
@@ -881,10 +882,10 @@ static void _writearray(unsigned char *address, const unsigned char *src,
         "lsr.l   #1,%%d1     \n"
         "addx.l  %%d0,%%d0   \n"
         "move.l  %%d1,%%a1   \n"
-        "move.l  %%a2,%%d1   \n"
+        "move.l  %[ax],%%d1  \n"
         "lsr.l   #1,%%d1     \n"
         "addx.l  %%d0,%%d0   \n"
-        "move.l  %%d1,%%a2   \n"
+        "move.l  %%d1,%[ax]  \n"
 
         "move.b  %%d0,(%[addr])  \n"  /* store byte to bitplane */
         "add.l   %[psiz],%[addr] \n"  /* advance to next bitplane */
@@ -894,13 +895,14 @@ static void _writearray(unsigned char *address, const unsigned char *src,
     ".wa_end:                \n"
         : /* outputs */
         [addr]"+a"(addr),
-        [mask]"+d"(_mask)
+        [mask]"+d"(_mask),
+        [ax]  "=&a"(trash)
         : /* inputs */
         [psiz]"a"(_gray_info.plane_size),
         [end] "a"(end),
-        [patp]"a"(pat_ptr)
+        [patp]"[ax]"(pat_ptr)
         : /* clobbers */
-        "d0", "d1", "d2", "d3", "d4", "d5", "d6", "a0", "a1", "a2"
+        "d0", "d1", "d2", "d3", "d4", "d5", "d6", "a0", "a1"
     );
 #endif
 }