firmware/drivers/isp1362.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2006 Jens Arnold
  11  *
  12  * All files in this archive are subject to the GNU General Public License.
  13  * See the file COPYING in the source tree root for full license agreement.
  14  *
  15  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  16  * KIND, either express or implied.
  17  *
  18  ****************************************************************************/
  19
  20 #include "system.h"
  21 #include "kernel.h"
  22 #include "isp1362.h"
  23
  24 #define HC_DATA (*((volatile unsigned short*)0xc0000000))
  25 #define HC_CMD  (*((volatile unsigned short*)0xc0000002))
  26 #define DC_DATA (*((volatile unsigned short*)0xc0000004))
  27 #define DC_CMD  (*((volatile unsigned short*)0xc0000006))
  28
  29 /* host controller access */
  30
  31 unsigned isp1362_read_hc_reg16(unsigned reg)
  32 {
  33     HC_CMD = reg;
  34
  35     asm ("nop\n nop\n nop\n nop\n");
  36     asm ("nop\n nop\n nop\n nop\n");
  37     asm ("nop\n nop\n nop\n nop\n");
  38
  39     return HC_DATA;
  40 }
  41
  42 unsigned isp1362_read_hc_reg32(unsigned reg)
  43 {
  44     unsigned data;
  45
  46     HC_CMD = reg;
  47
  48     asm ("nop\n nop\n nop\n nop\n");
  49     asm ("nop\n nop\n nop\n nop\n");
  50     asm ("nop\n nop\n nop\n nop\n");
  51
  52     data = HC_DATA;
  53     data |= HC_DATA << 16;
  54     return data;
  55 }
  56
  57 void isp1362_write_hc_reg16(unsigned reg, unsigned data)
  58 {
  59     HC_CMD = reg | 0x80;
  60
  61     asm ("nop\n nop\n nop\n");
  62
  63     HC_DATA = data;
  64 }
  65
  66 void isp1362_write_hc_reg32(unsigned reg, unsigned data)
  67 {
  68     HC_CMD = reg | 0x80;
  69
  70     asm ("nop\n nop\n nop\n");
  71
  72     HC_DATA = data;
  73     HC_DATA = data >> 16;
  74 }
  75
  76 /* device controller access */
  77
  78 unsigned isp1362_read_dc_reg16(unsigned reg)
  79 {
  80     DC_CMD = reg;
  81
  82     asm ("nop\n nop\n nop\n nop\n");
  83     asm ("nop\n nop\n nop\n nop\n");
  84     asm ("nop\n nop\n nop\n nop\n");
  85
  86     return DC_DATA;
  87 }
  88
  89 unsigned isp1362_read_dc_reg32(unsigned reg)
  90 {
  91     unsigned data;
  92
  93     DC_CMD = reg;
  94
  95     asm ("nop\n nop\n nop\n nop\n");
  96     asm ("nop\n nop\n nop\n nop\n");
  97     asm ("nop\n nop\n nop\n nop\n");
  98
  99     data = DC_DATA;
 100     data |= DC_DATA << 16;
 101     return data;
 102 }
 103
 104 void isp1362_write_dc_reg16(unsigned reg, unsigned data)
 105 {
 106     DC_CMD = reg;
 107
 108     asm ("nop\n nop\n nop\n");
 109
 110     DC_DATA = data;
 111 }
 112
 113 void isp1362_write_dc_reg32(unsigned reg, unsigned data)
 114 {
 115     DC_CMD = reg;
 116
 117     asm ("nop\n nop\n nop\n");
 118
 119     DC_DATA = data;
 120     DC_DATA = data >> 16;
 121 }
 122
 123 static void isp1362_suspend(void)
 124 {
 125     unsigned data;
 126
 127     data = isp1362_read_hc_reg16(ISP1362_OTG_CONTROL);
 128     data &= ~0x0001;  /* DRV_VBUS = 0 */
 129     isp1362_write_hc_reg16(ISP1362_OTG_CONTROL, data);
 130
 131     /* prepare the DC */
 132     data = isp1362_read_dc_reg16(ISP1362_DC_HARDWARE_CONFIG_R);
 133     data &= ~0x1008;  /* CLKRUN = WKUPCS = 0. Wakeup is still possible via /D_WAKEUP */
 134     isp1362_write_dc_reg16(ISP1362_DC_HARDWARE_CONFIG_W, data);
 135
 136     /* send the DC to sleep */
 137     data = isp1362_read_dc_reg16(ISP1362_DC_MODE_R);
 138     data |=  0x20;  /* GOSUSP = 1 */
 139     isp1362_write_dc_reg16(ISP1362_DC_MODE_W, data);
 140     data &= ~0x20;  /* GOSUSP = 0 */
 141     isp1362_write_dc_reg16(ISP1362_DC_MODE_W, data);
 142
 143     /* prepare the HC */
 144     data = isp1362_read_hc_reg16(ISP1362_HC_HARDWARE_CONFIG);
 145     data &= ~0x0800;  /* SuspendClkNotStop = 0 */
 146     data |=  0x4001;  /* GlobalPowerDown = InterruptPinEnable = 1 */
 147     isp1362_write_hc_reg16(ISP1362_HC_HARDWARE_CONFIG, data);
 148
 149     /* TODO: OTG wake-up cfg */
 150     /* TODO: Interrupt setup */
 151
 152     /* set the HC to operational */
 153     isp1362_write_hc_reg32(ISP1362_HC_CONTROL, 0x0680);
 154                            /* RWE = RWC = 1, HCFS = 0b10 (USBOperational) */
 155     /* ..then send it to sleep */
 156     isp1362_write_hc_reg32(ISP1362_HC_CONTROL, 0x06c0);
 157                            /* RWE = RWC = 1, HCFS = 0b11 (USBSuspend) */
 158 }
 159
 160 /* init */
 161
 162 void isp1362_init(void)
 163 {
 164     and_l(~0x00200080, &GPIO1_OUT);     /* disable 5V USB host power and ??? */
 165     or_l(  0x00200080, &GPIO1_ENABLE);
 166     or_l(  0x00200080, &GPIO1_FUNCTION);
 167
 168     or_l(  0x20600000, &GPIO_OUT);      /* ID = D_SUSPEND = /OTGMODE = 1 */
 169     and_l(~0x04000000, &GPIO_OUT);      /* ?R26? = 0 */
 170     or_l(  0x24600000, &GPIO_ENABLE);   /* ID, ?R26?, D_SUSPEND, /OTGMODE outputs */
 171     and_l(~0x000000a8, &GPIO_ENABLE);   /* /INT2, /INT1, /RESET inputs */
 172     or_l(  0x246000a8, &GPIO_FUNCTION); /* GPIO for these pins */
 173
 174     sleep(HZ/5);
 175
 176     isp1362_suspend();
 177 }