79 lines
2.2 KiB
C
79 lines
2.2 KiB
C
/*
|
|
* Original Copyright (c) 2001 by David Brownell
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
|
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
|
* for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software Foundation,
|
|
* Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
/* this file is part of ehci.c */
|
|
|
|
|
|
static inline void ehci_qtd_init(struct ehci_qtd *qtd
|
|
)
|
|
{
|
|
dma_addr_t dma = ehci_virt_to_dma(qtd);
|
|
memset (qtd, 0, sizeof *qtd);
|
|
qtd->qtd_dma = dma;
|
|
qtd->hw_token = (QTD_STS_HALT);
|
|
qtd->hw_next = EHCI_LIST_END();
|
|
qtd->hw_alt_next = EHCI_LIST_END();
|
|
}
|
|
static inline struct ehci_qtd * ehci_qtd_alloc(void)
|
|
{
|
|
struct ehci_qtd *qtd ;
|
|
//debug_printf("ehci_qtd used=%x\n",ehci->qtd_used);
|
|
BUG_ON(ehci->qtd_used>=EHCI_MAX_QTD);
|
|
qtd = ehci->qtds[ehci->qtd_used++];
|
|
ehci_qtd_init(qtd);
|
|
return qtd;
|
|
}
|
|
|
|
int ehci_mem_init (void)
|
|
{
|
|
int i;
|
|
u32 ptr = 0x1800000 - DEFAULT_I_TDPS * sizeof(__le32);
|
|
|
|
ehci->periodic = (u32*)ptr;
|
|
ehci->periodic_dma = ehci_virt_to_dma(ehci->periodic);
|
|
|
|
for (i = 0; i < DEFAULT_I_TDPS; i++)
|
|
ehci->periodic[i] = EHCI_LIST_END();
|
|
|
|
ehci_writel( ehci->periodic_dma, &ehci->regs->frame_list );
|
|
|
|
for(i=0;i<EHCI_MAX_QTD;i++)
|
|
{
|
|
ptr -= sizeof(struct ehci_qtd);
|
|
ehci->qtds[i] = (struct ehci_qtd*)(ptr);
|
|
}
|
|
|
|
ehci->qtd_used = 0;
|
|
|
|
ptr -= sizeof(struct ehci_qh);
|
|
ehci->asyncqh = (struct ehci_qh*)ptr;
|
|
|
|
ehci->asyncqh->ehci = ehci;
|
|
ehci->asyncqh->qh_dma = ehci_virt_to_dma(ehci->asyncqh);
|
|
ehci->asyncqh->qtd_head = NULL;
|
|
|
|
ptr -= sizeof(struct ehci_qh);
|
|
ehci->async = (struct ehci_qh*)ptr;
|
|
|
|
ehci->async->ehci = ehci;
|
|
ehci->async->qh_dma = ehci_virt_to_dma(ehci->async);
|
|
ehci->async->qtd_head = NULL;
|
|
|
|
return 0;
|
|
}
|