sys/src/boot/zynq/qspi.c

   1 #include <u.h>
   2 #include "dat.h"
   3 #include "fns.h"
   4
   5 enum {
   6         QSPI_CFG,
   7         QSPI_STATUS,
   8         QSPI_EN = 5,
   9         QSPI_TXD4 = 7,
  10         QSPI_RXD,
  11         QSPI_TXD1 = 32,
  12         QSPI_TXD2,
  13         QSPI_TXD3
  14 };
  15
  16 #define QSPI0 ((void *) 0xE000D000)
  17
  18 static u32int
  19 cmd(ulong *r, int sz, u32int c)
  20 {
  21         if(sz == 4)
  22                 r[QSPI_TXD4] = c;
  23         else
  24                 r[QSPI_TXD1 + sz - 1] = c;
  25         r[QSPI_CFG] |= 1<<16;
  26         while((r[QSPI_STATUS] & (1<<2|1<<4)) != (1<<2|1<<4))
  27                 ;
  28         return r[QSPI_RXD];
  29 }
  30
  31 void
  32 flash(void)
  33 {
  34         ulong *r;
  35
  36         r = QSPI0;
  37         r[QSPI_CFG] = 1<<31 | 1<<19 | 3<<6 | 1<<15 | 1<<14 | 1<<10 | 1<<3 | 1;
  38         r[QSPI_CFG] &= ~(1<<10);
  39         r[QSPI_EN] = 1;
  40         cmd(r, 1, 0x06);
  41 //      cmd(r, 3, 0xD8);
  42         for(;;)
  43                 print("%x\n", cmd(r, 2, 0x05));
  44
  45 }