#include <platforms.h>
#include <ppc/proc_reg.h>
#include <mach_debug.h>
#include <kern/assert.h>
#include <kern/cpu_number.h>
#include <kern/spl.h>
#include <mach/mach_types.h>
#include <types.h>
#include <pexpert/ppc/powermac.h>
#include <ppc/io_map_entries.h>
#include <pexpert/ppc/dbdma.h>
static int dbdma_alloc_index = 0;
dbdma_command_t *dbdma_alloc_commands = NULL;
void
dbdma_start(dbdma_regmap_t *dmap, dbdma_command_t *commands)
{
unsigned long addr = kvtophys((vm_offset_t) commands);
if (addr & 0xf)
panic("dbdma_start command structure not 16-byte aligned");
dmap->d_intselect = 0xff;
DBDMA_ST4_ENDIAN(&dmap->d_control,
DBDMA_CLEAR_CNTRL( (DBDMA_CNTRL_ACTIVE |
DBDMA_CNTRL_DEAD |
DBDMA_CNTRL_WAKE |
DBDMA_CNTRL_FLUSH |
DBDMA_CNTRL_PAUSE |
DBDMA_CNTRL_RUN )));
eieio();
while (DBDMA_LD4_ENDIAN(&dmap->d_status) & DBDMA_CNTRL_ACTIVE)
eieio();
dmap->d_cmdptrhi = 0; eieio();
DBDMA_ST4_ENDIAN(&dmap->d_cmdptrlo, addr); eieio();
DBDMA_ST4_ENDIAN(&dmap->d_control, DBDMA_SET_CNTRL(DBDMA_CNTRL_RUN));
eieio();
}
void
dbdma_stop(dbdma_regmap_t *dmap)
{
DBDMA_ST4_ENDIAN(&dmap->d_control, DBDMA_CLEAR_CNTRL(DBDMA_CNTRL_RUN) |
DBDMA_SET_CNTRL(DBDMA_CNTRL_FLUSH)); eieio();
while (DBDMA_LD4_ENDIAN(&dmap->d_status) & (DBDMA_CNTRL_ACTIVE|DBDMA_CNTRL_FLUSH))
eieio();
}
void
dbdma_flush(dbdma_regmap_t *dmap)
{
DBDMA_ST4_ENDIAN(&dmap->d_control,DBDMA_SET_CNTRL(DBDMA_CNTRL_FLUSH));
eieio();
while (DBDMA_LD4_ENDIAN(&dmap->d_status) & (DBDMA_CNTRL_FLUSH))
eieio();
}
void
dbdma_reset(dbdma_regmap_t *dmap)
{
DBDMA_ST4_ENDIAN(&dmap->d_control,
DBDMA_CLEAR_CNTRL( (DBDMA_CNTRL_ACTIVE |
DBDMA_CNTRL_DEAD |
DBDMA_CNTRL_WAKE |
DBDMA_CNTRL_FLUSH |
DBDMA_CNTRL_PAUSE |
DBDMA_CNTRL_RUN )));
eieio();
while (DBDMA_LD4_ENDIAN(&dmap->d_status) & DBDMA_CNTRL_RUN)
eieio();
}
void
dbdma_continue(dbdma_regmap_t *dmap)
{
DBDMA_ST4_ENDIAN(&dmap->d_control, DBDMA_SET_CNTRL(DBDMA_CNTRL_RUN|DBDMA_CNTRL_WAKE) | DBDMA_CLEAR_CNTRL(DBDMA_CNTRL_PAUSE|DBDMA_CNTRL_DEAD));
eieio();
}
void
dbdma_pause(dbdma_regmap_t *dmap)
{
DBDMA_ST4_ENDIAN(&dmap->d_control,DBDMA_SET_CNTRL(DBDMA_CNTRL_PAUSE));
eieio();
while (DBDMA_LD4_ENDIAN(&dmap->d_status) & DBDMA_CNTRL_ACTIVE)
eieio();
}
dbdma_command_t *
dbdma_alloc(int count)
{
dbdma_command_t *dbdmap;
assert(cpu_number() == master_cpu);
if (dbdma_alloc_index == 0)
dbdma_alloc_commands = (dbdma_command_t *) io_map(0, PAGE_SIZE);
if ((dbdma_alloc_index+count) >= PAGE_SIZE / sizeof(dbdma_command_t))
panic("Too many dbdma command structures!");
dbdmap = &dbdma_alloc_commands[dbdma_alloc_index];
dbdma_alloc_index += count;
return dbdmap;
}