dma.c

/*
# _____     ___ ____     ___ ____
#  ____|   |    ____|   |        | |____|
# |     ___|   |____ ___|    ____| |    \    PS2DEV Open Source Project.
#-----------------------------------------------------------------------
# (c) 2009 Lion
# Licenced under Academic Free License version 2.0
# Review ps2sdk README & LICENSE files for further details.
*/
 
#include <errno.h>
#include <stdio.h>
#include <kernel.h>
#include <libgs.h>
 
#include "internal.h"
 
// Miscellaneous
 
#define gif_chcr    0x1000a000
#define gif_madr    0x1000a010
#define gif_qwc     0x1000a020
#define gif_tadr    0x1000a030
 
 #define DMA_TAG_REFE   0x00
 #define DMA_TAG_CNT    0x01
 #define DMA_TAG_NEXT   0x02
 #define DMA_TAG_REF    0x03
 #define DMA_TAG_REFS   0x04
 #define DMA_TAG_CALL   0x05
 #define DMA_TAG_RET    0x06
 #define DMA_TAG_END    0x07
 
typedef struct {
    unsigned direction  :1;
    unsigned pad1       :1; 
    unsigned mode       :2;
    unsigned asp        :2;
    unsigned tte        :1;
    unsigned tie        :1;
    unsigned start_flag :1;
    unsigned pad2       :7; 
    unsigned tag        :16;
}DMA_CHCR;
 
void GsDmaInit(void)
{
    /* This appears to have been based on code from Sony that initializes DMA channels 0-9, in bulk.
           Reset/init DMA CH 2 (GIF) only. */
    __asm__(
    "li $2,0x1000A000   \n"
    "sw $0,0x80($2)     \n" // D2_SADR = 0. Documented to not exist, but is done.
    "sw $0,0($2)        \n" // D2_CHCR = 0
    "sw $0,0x30($2)     \n" // D2_TADR = 0
    "sw $0,0x10($2)     \n" // D2_MADR = 0
    "sw $0,0x50($2)     \n" // D2_ASR1 = 0
    "sw $0,0x40($2)     \n" // D2_ASR0 = 0
    "li $2,0xFF1F       \n" // Clear all interrupt status under D_STAT, other than SIF0, SIF1 & SIF2.
    "sw $2,0x1000E010   \n"
    "lw $2,0x1000E010   \n"
    "lui    $3,0xFF1F       \n" // Clear all interrupt masks under D_STAT, other SIF0, SIF1 & SIF2. Writing a 1 reverses the bit.
    "and    $2,$3       \n"
    "sw $2,0x1000E010   \n"
    "sw $0,0x1000E000   \n" // D_CTRL = 0
    "sw $0,0x1000E020   \n" // D_PCR = 0
    "sw $0,0x1000E030   \n" // D_SQWC = 0
    "sw $0,0x1000E050   \n" // D_RBOR = 0
    "sw $0,0x1000E040   \n" // D_RBSR = 0
    "li $3,1            \n"
    "lw $2,0x1000E000   \n"
    "ori    $3,$2,1     \n" // D_CTRL (DMAE 1)
    "sw $3,0x1000E000   \n"
    );
}
 
void GsDmaSend(const void *addr, u32 qwords)
{
    DMA_CHCR        chcr;
    static char     spr;
 
    if((u32)addr >= 0x70000000 && (u32)addr <= 0x70003fff)
    {
        spr = 1;
    }
    else
    {
        spr = 0;
    }
 
    *((vu32 *)(gif_madr)) = ( u32 )((( u32 )addr) & 0x7FFFFFFF) << 0 | (u32)((spr) & 0x00000001) << 31;;
 
    *((vu32 *)(gif_qwc)) = qwords;
 
    chcr.direction  =1;
    chcr.mode       =0;
    chcr.asp        =0;
    chcr.tte        =0;
    chcr.tie        =0;
    chcr.start_flag =1;
    chcr.tag        =0;
    chcr.pad1       =0;
    chcr.pad2       =0;
 
    // This prevents the compiler from assuming the values in addr are unused,
    // and that the writes to addr can be delayed until after this function call
    asm("":::"memory");
 
    *((volatile DMA_CHCR *)(gif_chcr)) = chcr;
}
 
void GsDmaSend_tag(const void *addr, u32 qwords, const GS_GIF_DMACHAIN_TAG *tag)
{
    DMA_CHCR        chcr;
    static char     spr;
 
    if((u32)addr >= 0x70000000 && (u32)addr <= 0x70003fff)
    {
        spr = 1;
    }
    else
    {
        spr = 0;
    }
 
    *((vu32 *)(gif_madr)) = ( u32 )((( u32 )addr) & 0x7FFFFFFF) << 0 | (u32)((spr) & 0x00000001) << 31;
    *((vu32 *)(gif_qwc)) = qwords;
    *((vu32 *)(gif_tadr)) = ( u32 )((( u32 )tag) & 0x7FFFFFFF) << 0 | (u32)((0) & 0x00000001) << 31;
 
    chcr.direction  =1;
    chcr.mode       =1; //chain
    chcr.asp        =0;
    chcr.tte        =0;
    chcr.tie        =0;
    chcr.start_flag =1;
    chcr.tag        =0;
    chcr.pad1       =0;
    chcr.pad2       =0;
 
    // This prevents the compiler from assuming the values in addr are unused,
    // and that the writes to addr can be delayed until after this function call
    asm("":::"memory");
 
    *((volatile DMA_CHCR *)(gif_chcr)) = chcr;
}
 
void GsDmaWait(void)
{
    while(*((vu32 *)(0x1000a000)) & ((u32)1<<8));
    asm("":::"memory");
}