/*
**ucosII for simuCPU,you can only free use it for personal study purpose!
**www.MShowTec.com for more information.
**lmjx,Email:limiao@yeah.com,All Right Reserved.
**/

#include <stdio.h>
#include <string.h>
#include "iofn.h"

static char outbuf[128];

void init_fuc(int argc,char *argv[]) 
{
   //dsc0_00LCDInit();
}

void red_fuc(int argc,char *argv[]) 
{
   //write_red_data();
}


void green_fuc(int argc,char *argv[])
{
   //write_green_data();
}

void blue_fuc(int argc,char *argv[])
{
   //write_blue_data();
}

void pic_fuc(int argc,char *argv[])
{
  //write_pic_data();
}

void lcdcmd_fuc(int argc,char *argv[])
{
      unsigned short idx;

      idx = str2hex(argv[0]);

      sprintf(outbuf,"idx:0x%04x\r\n",idx);
      output(outbuf);
      //SendLcdCommand(idx);
}

void lcdpara_fuc(int argc,char *argv[])
{
      unsigned short val;

      val = str2hex(argv[0]);

      sprintf(outbuf,"val:0x%04x\r\n",val);
      output(outbuf);
      //SendLcdParam(val);
}

void pre_fuc(int argc,char *argv[])
{
   //preview();
}

void colorval_fuc(int argc,char *argv[])
{
	int val;

	val = str2hex(argv[0]);      

	//dsc2_27SetCamColor(val);
}

void modeval_fuc(int argc,char *argv[])
{
  	int val;

	val = str2hex(argv[0]);      

	//dsc2_28SetCamMode(val);
}

void camreg_fuc(int argc,char *argv[])
{
      unsigned char idx,val;

      idx = str2hex(argv[0]);
      val = str2hex(argv[1]);

      sprintf(outbuf,"idx:0x%02x,val:0x%02x\r\n",idx,val);
      output(outbuf);
      //SetCamCmd(idx,val);
	  
}

void read_sys_reg_fuc(int argc,char *argv[])
{
	unsigned int addr;
	unsigned short val;

	//if(!strcmp("cprs",argv[0])){
	//	sprintf(outbuf,"CPRS:0x%08x\r\n",din6_0GetCPSR());
     // 	 	output(outbuf);
	//	return;
	//}
	
	addr = str2hex(argv[0]);
	val = *( ( volatile unsigned short *) (addr) );
	
	 sprintf(outbuf,"read address:0x%08x,val:0x%04x\r\n",addr,val);
      	 output(outbuf);
}

void write_sys_reg_fuc(int argc,char *argv[])
{
	unsigned int addr;
	unsigned short val;


	addr = str2hex(argv[0]);
	//addr += 0xFFFF8000;
	
	val = str2hex(argv[1]);
	*( ( volatile unsigned short *) (addr) ) = val; 

	 sprintf(outbuf,"write address:0x%08x,val:0x%04x\r\n",addr,val);
      	 output(outbuf);
}