vbatts/grub
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

Move p2v and v2p to pci.h

Browse source
This commit is contained in:
Vladimir 'phcoder' Serbinenko 2011-10-01 21:37:02 +02:00
parent e5c0534f0b
commit 0a213f4cdb
2 changed files with 30 additions and 29 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

44
grub-core/bus/usb/ehci.c
View file

@ -402,20 +402,6 @@ grub_ehci_port_setbits (struct grub_ehci *e, grub_uint32_t port,
grub_ehci_port_read (e, port); grub_ehci_port_read (e, port);
} }
static inline void *
grub_ehci_phys2virt (grub_uint32_t phys, struct grub_pci_dma_chunk *chunk)
{
return ((grub_uint8_t *) grub_dma_get_virt (chunk)
+ (phys - grub_dma_get_phys (chunk)));
}
static inline grub_uint32_t
grub_ehci_virt2phys (volatile void *virt, struct grub_pci_dma_chunk *chunk)
{
return (((grub_uint8_t *) virt - (grub_uint8_t *) grub_dma_get_virt (chunk))
+ grub_dma_get_phys (chunk));
}
/* Halt if EHCI HC not halted */ /* Halt if EHCI HC not halted */
static grub_err_t static grub_err_t
grub_ehci_halt (struct grub_ehci *e) grub_ehci_halt (struct grub_ehci *e)
@ -662,7 +648,7 @@ grub_ehci_pci_iter (grub_pci_device_t dev,
for (i = 1; i < GRUB_EHCI_N_QH; i++) for (i = 1; i < GRUB_EHCI_N_QH; i++)
{ {
e->qh_virt[i].qh_hptr = e->qh_virt[i].qh_hptr =
grub_cpu_to_le32 ((grub_ehci_virt2phys (&e->qh_virt[i], grub_cpu_to_le32 ((grub_dma_virt2phys (&e->qh_virt[i],
e->qh_chunk) & e->qh_chunk) &
GRUB_EHCI_POINTER_MASK) | GRUB_EHCI_HPTR_TYPE_QH); GRUB_EHCI_POINTER_MASK) | GRUB_EHCI_HPTR_TYPE_QH);
e->qh_virt[i].td_overlay.next_td = e->qh_virt[i].td_overlay.next_td =
@ -754,7 +740,7 @@ grub_ehci_pci_iter (grub_pci_device_t dev,
/* Setup list address registers */ /* Setup list address registers */
grub_ehci_oper_write32 (e, GRUB_EHCI_FL_BASE, e->framelist_phys); grub_ehci_oper_write32 (e, GRUB_EHCI_FL_BASE, e->framelist_phys);
grub_ehci_oper_write32 (e, GRUB_EHCI_CUR_AL_ADDR, grub_ehci_oper_write32 (e, GRUB_EHCI_CUR_AL_ADDR,
grub_ehci_virt2phys (&e->qh_virt[1], grub_dma_virt2phys (&e->qh_virt[1],
e->qh_chunk)); e->qh_chunk));
/* Set ownership of root hub ports to EHCI */ /* Set ownership of root hub ports to EHCI */
@ -966,12 +952,12 @@ grub_ehci_find_qh (struct grub_ehci *e, grub_usb_transfer_t transfer)
grub_ehci_setup_qh (&qh[i], transfer); grub_ehci_setup_qh (&qh[i], transfer);
/* Linking - this new (last) QH will point to first QH */ /* Linking - this new (last) QH will point to first QH */
qh[i].qh_hptr = grub_cpu_to_le32 (GRUB_EHCI_HPTR_TYPE_QH qh[i].qh_hptr = grub_cpu_to_le32 (GRUB_EHCI_HPTR_TYPE_QH
| grub_ehci_virt2phys (&qh[1], | grub_dma_virt2phys (&qh[1],
e->qh_chunk)); e->qh_chunk));
/* Linking - previous last QH will point to this new QH */ /* Linking - previous last QH will point to this new QH */
qh[i - 1].qh_hptr = grub_cpu_to_le32 (GRUB_EHCI_HPTR_TYPE_QH qh[i - 1].qh_hptr = grub_cpu_to_le32 (GRUB_EHCI_HPTR_TYPE_QH
| grub_ehci_virt2phys (&qh[i], | grub_dma_virt2phys (&qh[i],
e->qh_chunk)); e->qh_chunk));
return &qh[i]; return &qh[i];
} }
@ -991,7 +977,7 @@ grub_ehci_alloc_td (struct grub_ehci *e)
ret = e->tdfree_virt; /* Take current free TD */ ret = e->tdfree_virt; /* Take current free TD */
/* Advance to next free TD in chain */ /* Advance to next free TD in chain */
if (ret->link_td) if (ret->link_td)
e->tdfree_virt = grub_ehci_phys2virt (ret->link_td, e->td_chunk); e->tdfree_virt = grub_dma_phys2virt (ret->link_td, e->td_chunk);
else else
e->tdfree_virt = NULL; e->tdfree_virt = NULL;
ret->link_td = 0; /* Reset link_td in allocated TD */ ret->link_td = 0; /* Reset link_td in allocated TD */
@ -1003,7 +989,7 @@ grub_ehci_free_td (struct grub_ehci *e, grub_ehci_td_t td)
{ {
/* Chain new free TD & rest */ /* Chain new free TD & rest */
if (e->tdfree_virt) if (e->tdfree_virt)
td->link_td = grub_ehci_virt2phys (e->tdfree_virt, e->td_chunk); td->link_td = grub_dma_virt2phys (e->tdfree_virt, e->td_chunk);
else else
td->link_td = 0; td->link_td = 0;
e->tdfree_virt = td; /* Change address of first free TD */ e->tdfree_virt = td; /* Change address of first free TD */
@ -1039,7 +1025,7 @@ grub_ehci_free_tds (struct grub_ehci *e, grub_ehci_td_t td,
/* Unlink the TD */ /* Unlink the TD */
tdprev = td; tdprev = td;
if (td->link_td) if (td->link_td)
td = grub_ehci_phys2virt (td->link_td, e->td_chunk); td = grub_dma_phys2virt (td->link_td, e->td_chunk);
else else
td = NULL; td = NULL;
@ -1112,7 +1098,7 @@ grub_ehci_transaction (struct grub_ehci *e,
* will not be really fetched because it is not active. But don't * will not be really fetched because it is not active. But don't
* forget, EHCI will try to fetch alternate TD every scan of AL * forget, EHCI will try to fetch alternate TD every scan of AL
* until QH is halted. */ * until QH is halted. */
td->alt_next_td = grub_cpu_to_le32 (grub_ehci_virt2phys (td_alt, td->alt_next_td = grub_cpu_to_le32 (grub_dma_virt2phys (td_alt,
e->td_chunk)); e->td_chunk));
/* token: /* token:
* TOGGLE - according to toggle * TOGGLE - according to toggle
@ -1269,9 +1255,9 @@ grub_ehci_setup_transfer (grub_usb_controller_t dev,
cdata->td_first_virt = td; cdata->td_first_virt = td;
else else
{ {
td_prev->link_td = grub_ehci_virt2phys (td, e->td_chunk); td_prev->link_td = grub_dma_virt2phys (td, e->td_chunk);
td_prev->next_td = td_prev->next_td =
grub_cpu_to_le32 (grub_ehci_virt2phys (td, e->td_chunk)); grub_cpu_to_le32 (grub_dma_virt2phys (td, e->td_chunk));
} }
td_prev = td; td_prev = td;
} }
@ -1295,7 +1281,7 @@ grub_ehci_setup_transfer (grub_usb_controller_t dev,
grub_cpu_to_le32 (GRUB_EHCI_TERMINATE); grub_cpu_to_le32 (GRUB_EHCI_TERMINATE);
/* Link new TDs with QH via next_td */ /* Link new TDs with QH via next_td */
cdata->qh_virt->td_overlay.next_td = cdata->qh_virt->td_overlay.next_td =
grub_cpu_to_le32 (grub_ehci_virt2phys grub_cpu_to_le32 (grub_dma_virt2phys
(cdata->td_first_virt, e->td_chunk)); (cdata->td_first_virt, e->td_chunk));
/* Reset Active and Halted bits in QH to activate Advance Queue, /* Reset Active and Halted bits in QH to activate Advance Queue,
* i.e. reset token */ * i.e. reset token */
@ -1547,7 +1533,7 @@ grub_ehci_cancel_transfer (grub_usb_controller_t dev,
/* Finaly we should return QH back to the AL... */ /* Finaly we should return QH back to the AL... */
e->qh_virt[i - 1].qh_hptr = e->qh_virt[i - 1].qh_hptr =
grub_cpu_to_le32 (grub_ehci_virt2phys grub_cpu_to_le32 (grub_dma_virt2phys
(cdata->qh_virt, e->qh_chunk)); (cdata->qh_virt, e->qh_chunk));
grub_free (cdata); grub_free (cdata);
@ -1745,7 +1731,7 @@ grub_ehci_restore_hw (void)
/* Setup some EHCI registers and enable EHCI */ /* Setup some EHCI registers and enable EHCI */
grub_ehci_oper_write32 (e, GRUB_EHCI_FL_BASE, e->framelist_phys); grub_ehci_oper_write32 (e, GRUB_EHCI_FL_BASE, e->framelist_phys);
grub_ehci_oper_write32 (e, GRUB_EHCI_CUR_AL_ADDR, grub_ehci_oper_write32 (e, GRUB_EHCI_CUR_AL_ADDR,
grub_ehci_virt2phys (&e->qh_virt[1], grub_dma_virt2phys (&e->qh_virt[1],
e->qh_chunk)); e->qh_chunk));
grub_ehci_oper_write32 (e, GRUB_EHCI_COMMAND, grub_ehci_oper_write32 (e, GRUB_EHCI_COMMAND,
GRUB_EHCI_CMD_RUNSTOP | GRUB_EHCI_CMD_RUNSTOP |

15
include/grub/pci.h
View file

@ -132,6 +132,21 @@ void EXPORT_FUNC(grub_dma_free) (struct grub_pci_dma_chunk *ch);
volatile void *EXPORT_FUNC(grub_dma_get_virt) (struct grub_pci_dma_chunk *ch); volatile void *EXPORT_FUNC(grub_dma_get_virt) (struct grub_pci_dma_chunk *ch);
grub_uint32_t EXPORT_FUNC(grub_dma_get_phys) (struct grub_pci_dma_chunk *ch); grub_uint32_t EXPORT_FUNC(grub_dma_get_phys) (struct grub_pci_dma_chunk *ch);
static inline void *
grub_dma_phys2virt (grub_uint32_t phys, struct grub_pci_dma_chunk *chunk)
{
return ((grub_uint8_t *) grub_dma_get_virt (chunk)
+ (phys - grub_dma_get_phys (chunk)));
}
static inline grub_uint32_t
grub_dma_virt2phys (volatile void *virt, struct grub_pci_dma_chunk *chunk)
{
return (((grub_uint8_t *) virt - (grub_uint8_t *) grub_dma_get_virt (chunk))
+ grub_dma_get_phys (chunk));
}
#endif #endif
#endif /* GRUB_PCI_H */ #endif /* GRUB_PCI_H */