static int dmac_setup_xfer (dmac_dev_t * dmac_dev, paddr_t paddr, int len, int dir)
{
	int i, blknum = len/dmac_dev->blksz;

	dmac_dev->blknum = blknum;
	memset(dmac_dev->lli, 0, blknum * sizeof(at91sam9xx_dmac_bd_t));

	/* Resume Channel */
	dmac_dev->dmac->chdr = 1 << (dmac_dev->chid + 8);

	if (dir == DATA_READ) {		/* Block READ */
		/* Setup DMA direction */
		dmac_dev->dmac->lli[dmac_dev->chid].cfg &= ~(DMAC_DST_H2SEL_SW | DMAC_SRC_H2SEL_HW);
		dmac_dev->dmac->lli[dmac_dev->chid].cfg |= DMAC_DST_H2SEL_SW | DMAC_SRC_H2SEL_HW;

		/* Setup link list */
		for (i = 0; i < blknum; i++) {
			/* Set Source and address transfer size and modulo operation */
			dmac_dev->lli[i].ctrla = ((dmac_dev->blksz/4) & 0xffff)
				| SRC_WIDTH(2) | DST_WIDTH(2) | SCSIZE;
			dmac_dev->lli[i].ctrlb = DMAC_FC_PER2MEM | FLAG_SRC_INCREMENT
				| FLAG_DST_INCREMENT | SET_DST_DSCR;
			dmac_dev->lli[i].saddr = dmac_dev->io_addr;
			dmac_dev->lli[i].daddr = paddr + dmac_dev->blksz * i;

			if (i == blknum - 1)
				/* Set last lli descriptor to 0 to mark NULL */
				dmac_dev->lli[i].dscr = 0;
			else
				/* Set next lli descriptor */
				dmac_dev->lli[i].dscr = lli_mphy + (i + 1) * lli_size;
		}
	} else if (dir == DATA_WRITE) {	/* Block WRITE */
		/* Setup DMA direction */
		dmac_dev->dmac->lli[dmac_dev->chid].cfg &= ~(DMAC_DST_H2SEL_HW | DMAC_SRC_H2SEL_SW);
		dmac_dev->dmac->lli[dmac_dev->chid].cfg |= DMAC_DST_H2SEL_HW | DMAC_SRC_H2SEL_SW;

		for (i = 0; i < blknum; i++) {
			/* Set Source and address transfer size and modulo operation */
			dmac_dev->lli[i].ctrla = ((dmac_dev->blksz/4) & 0xffff)
				| SRC_WIDTH(2) | DST_WIDTH(2) | DCSIZE;
			dmac_dev->lli[i].ctrlb = DMAC_FC_MEM2PER | FLAG_SRC_INCREMENT
				| FLAG_DST_INCREMENT | SET_SRC_DSCR;
			dmac_dev->lli[i].saddr = paddr + dmac_dev->blksz * i;
			dmac_dev->lli[i].daddr = dmac_dev->io_addr;
			if (i == blknum - 1)
				/* Set last lli descriptor to 0 to mark NULL */
				dmac_dev->lli[i].dscr = 0;
			else
				/* Set next lli descriptor */
				dmac_dev->lli[i].dscr = lli_mphy + (i + 1) * lli_size;
		}
	} else {
		slogf (_SLOGC_SIM_MMC, _SLOG_ERROR, "MMC: DMA setup_xfer neither READ or WRITE\n");
		return -1;
	}

	return 0;
}
static POST_ERROR Post_update_condition(void)
{
    POST_ERROR error = POST_SUCCESS;

    unsigned int PreHozRatio, PreVerRatio;
    unsigned int MainHozShift, MainVerShift;

    POST_MSG((_T("[POST]++Post_update_condition()\n\r")));

    error = Post_get_prescaler_shiftvalue(&MainHozShift, g_PostConfig.SrcWidth, g_PostConfig.DstWidth);
    if (error == POST_SUCCESS)
    {
        PreHozRatio = (1<<MainHozShift);
        error = Post_get_prescaler_shiftvalue(&MainVerShift, g_PostConfig.SrcHeight, g_PostConfig.DstHeight);
        if (error == POST_SUCCESS)
        {
            PreVerRatio = (1<<MainVerShift);
            g_pPostReg->PreScale_Ratio = PRESCALE_V_RATIO(PreVerRatio) | PRESCALE_H_RATIO(PreHozRatio);
            g_pPostReg->PreScaleImgSize = PRESCALE_WIDTH(g_PostConfig.SrcWidth/PreHozRatio) | PRESCALE_HEIGHT(g_PostConfig.SrcHeight/PreVerRatio);
            g_pPostReg->SRCImgSize = SRC_WIDTH(g_PostConfig.SrcWidth) | SRC_HEIGHT(g_PostConfig.SrcHeight);
            g_pPostReg->MainScale_H_Ratio = MAINSCALE_H_RATIO((g_PostConfig.SrcWidth<<8)/(g_PostConfig.DstWidth<<MainHozShift));
            g_pPostReg->MainScale_V_Ratio = MAINSCALE_V_RATIO((g_PostConfig.SrcHeight<<8)/(g_PostConfig.DstHeight<<MainVerShift));
            g_pPostReg->DSTImgSize = DST_WIDTH(g_PostConfig.DstWidth) | DST_HEIGHT(g_PostConfig.DstHeight);
            g_pPostReg->PreScale_SHFactor = PRESCALE_SHFACTOR(10-(MainHozShift+MainVerShift));
        }
    }

    POST_MSG((_T("[POST]--Post_update_condition() : %d\n\r"), error));

    return error;
}
static TVSC_ERROR TVSC_update_condition(void)
{
	TVSC_ERROR error = TVSC_SUCCESS;

	unsigned int PreHozRatio, PreVerRatio;
	unsigned int MainHozShift, MainVerShift;

	TVSC_MSG((_T("[TVSC]++TVSC_update_condition()\n\r")));

	error = TVSC_get_prescaler_horizontal_value(&PreHozRatio, &MainHozShift);
	if (error == TVSC_SUCCESS)
	{
		error = TVSC_get_prescaler_vertical_value(&PreVerRatio, &MainVerShift);
		if (error == TVSC_SUCCESS)
		{
			g_pTVSCReg->PreScale_Ratio = PRESCALE_V_RATIO(PreVerRatio) | PRESCALE_H_RATIO(PreHozRatio);
			g_pTVSCReg->PreScaleImgSize = PRESCALE_WIDTH(g_TVSCConfig.SrcWidth/PreHozRatio) | PRESCALE_HEIGHT(g_TVSCConfig.SrcHeight/PreVerRatio);
			g_pTVSCReg->SRCImgSize = SRC_WIDTH(g_TVSCConfig.SrcWidth) | SRC_HEIGHT(g_TVSCConfig.SrcHeight);
			g_pTVSCReg->MainScale_H_Ratio = MAINSCALE_H_RATIO((g_TVSCConfig.SrcWidth<<8)/(g_TVSCConfig.DstWidth<<MainHozShift));
			g_pTVSCReg->MainScale_V_Ratio = MAINSCALE_V_RATIO((g_TVSCConfig.SrcHeight<<8)/(g_TVSCConfig.DstHeight<<MainVerShift));
			g_pTVSCReg->DSTImgSize = DST_WIDTH(g_TVSCConfig.DstWidth) | DST_HEIGHT(g_TVSCConfig.DstHeight);
			g_pTVSCReg->PreScale_SHFactor = PRESCALE_SHFACTOR(10-(MainHozShift+MainVerShift));
		}
	}

	TVSC_MSG((_T("[TVSC]--TVSC_update_condition() : %d\n\r"), error));

	return error;
}