/**
  *****************************************************************************
  * 						ָؿ
  *****************************************************************************
  *
  * @File   : CMD_Handle.c
  * @By     : Huang
  * @Version: V1.0
  * @Date   : 2025 / 03 / 21
  * @Shop	: https://xiaomeige.taobao.com/
  *
  *****************************************************************************
**/

#include "CMD_Handle.h"
#include "xaxidma.h"

XClk_Wiz XCLK;

uint32_t restart;
uint8_t ChannelSel;
uint32_t DataNum;
uint32_t Speed_Set;
uint32_t PLL_Reconfig;
uint8_t devinfo = 0;
uint8_t Reconfig = 0;
uint32_t clk_wiz_data;

volatile uint8_t Error = 0;
volatile uint8_t sample_send_flag = 0;

uint32_t RX_BUFFER_BASE = ADC_Data_Addr;
uint8_t buffer[sizeof(ADC_info)];
uint32_t send_data = 0;//ֽ
uint32_t data_rest = 0;//ֽ
uint32_t uiIdx = 0;

/************************************************************************************************************
**  @brief	֡ʽָ
**  @param	cmd_buffer ָ
**
************************************************************************************************************/
void cmd_analysis(uint8_t *cmd_buffer)
{
	unsigned char cmd[8] = {0};
	for(int i=0;i<8;i++){
		cmd[i] = *(cmd_buffer+i);
	}

	if((cmd[0] == 0x55) && (cmd[1] == 0xA5) && (cmd[7] == 0xF0))
	{
		switch(cmd[2])
		{
			case 0: restart = 1;break;
			case 1: ChannelSel = cmd[6];break;
			case 2: DataNum = (cmd[3] << 24) | (cmd[4] << 16) | (cmd[5] << 8) | cmd[6];break;
			case 3: Speed_Set = (cmd[3] << 24) | (cmd[4] << 16) | (cmd[5] << 8) | cmd[6];break;
			case 5: PLL_Reconfig = (cmd[3] << 24) | (cmd[4] << 16) | (cmd[5] << 8) | cmd[6];
					Reconfig = 1;
					break;
			case 255: devinfo = 1; break;
			default:break;
		}
	}
}

/************************************************************************************************************
**  @brief	clk_wiz_Configд
**  @param	CMD	  32λPLLдָ
**			                     31:28ָģʽ    4'b0000ʱӷƵ      4'b0001λ
**							    4'b0010ռձȣ          4'b0100Ĵ      4'b1000 
**				      27:24ʱѡ CLK1~CLK6(MMCMCLK7)
**				      23:0 дĴʱΪӦעʱӷƵʱbit[17:8]СƵMMCMbit[7:0]Ƶ
**				      			  λռձʱҪ*1000
**				      	    ĴʱΪӦĴƫƵַ
**  Sample:	clk_wiz_Config(0x1101f420);	//CLK1(ӦGUIеCLK0)ʱӷƵΪ32.5Ƶ
************************************************************************************************************/
void clk_wiz_Config(uint32_t CMD)
{
	uint32_t offset = 0;
	uint8_t cmd_mode = 0;
 	//PLLָЧ
	if(Reconfig){
		cmd_mode = CMD >>28;
		//ǶĴ
		if(cmd_mode == 4){
			clk_wiz_data = Xil_In32(XPAR_CLK_WIZ_0_BASEADDR + (CMD & 0xffffff));
			printf("Ĵ0x%xֵΪ%x\n",CMD & 0xffffff,clk_wiz_data);
		}
		//ʱ
		else{
			offset = 208+ 12*(((CMD >>24)&0xf)-1);
			//ʱӷƵ
			if(cmd_mode == 0){
				Xil_Out32(XPAR_CLK_WIZ_0_BASEADDR + offset,CMD & 0xffffff);
				Xil_Out32(XPAR_CLK_WIZ_0_BASEADDR + 0x25C,0x03);//updata configuration
			}
			//λ
			else if(cmd_mode == 1){
				Xil_Out32(XPAR_CLK_WIZ_0_BASEADDR + offset + 4,CMD & 0xffffff);
				Xil_Out32(XPAR_CLK_WIZ_0_BASEADDR + 0x25C,0x03);//updata configuration
			}
			//ռձ
			else if(cmd_mode == 1){
				Xil_Out32(XPAR_CLK_WIZ_0_BASEADDR + offset + 8,CMD & 0xffffff);
				Xil_Out32(XPAR_CLK_WIZ_0_BASEADDR + 0x25C,0x03);//updata configuration
			}
		}
		Reconfig = 0;
	}
}

/************************************************************************************************************
**  @brief	λADCϢ
**  @param	
**  Sample:	Send_ADC_Info();//Ԥ͸λ
************************************************************************************************************/
void Send_ADC_Info()
{
	if(devinfo == 1)
	{
		memcpy(buffer, &ACM9238_info, sizeof(ADC_info));
		tcp_write(serpcb,&ACM9238_info,sizeof(ADC_info),1);
		tcp_output(serpcb);
		pbuf_free(serpcb->refused_data);
		devinfo = 0;
	}
}

/************************************************************************************************************
**  @brief	ʼADCز
**  @param	ֽ
**  Sample:	Restart_ADC_Sample(1024);//ʼADCزɼ1024ֽ
************************************************************************************************************/
void Restart_ADC_Sample(u32 Bytes)
{
	if(restart)
	{
		//洢Ҫ͵
		send_data = Bytes;

		Xil_Out32(XSLCR_UNLOCK_ADDR, XSLCR_UNLOCK_CODE);
		Xil_Out32(XSLCR_FPGA_RST_CTRL_ADDR, 0x0F);
		usleep(50);
		//and release the FPGA Reset Signal
		Xil_Out32(XSLCR_FPGA_RST_CTRL_ADDR, 0x00);
		Xil_Out32(XSLCR_LOCK_ADDR, XSLCR_LOCK_CODE);

		usleep(50);

		if(Bytes > 0x3ff0000){
			start_trans_data(0x3ff0000, ADC_Data_Addr);
			data_rest = Bytes - 0x3ff0000;
			Bytes = 0x3ff0000;

		}
		else{
			start_trans_data(Bytes, ADC_Data_Addr);
			data_rest = 0;
		}

		ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,DATA_SUM,send_data);//ֽܲ
		ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,CH_SEL,ChannelSel);//ͨѡ
		ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,SPEED_CTRL,Speed_Set);//ٶ
		ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,BYTES_Trans,Bytes);//δֽ

		ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,SAMPLE_EN_GO,0x101);//ʹsample_enGo; bit[8]bit[0]

		restart = 0;

		sample_send_flag = 1;
	}
}

/************************************************************************************************************
**  @brief	ݰ˼
**  @param	
**  Sample:	Data_Recive_Trans();//ʼDMAˣȫɺ󣬽TCP
************************************************************************************************************/
void Data_Recive_Trans()
{
	uint32_t buff;

	uint32_t irq_status;


	if(RxDone) {
		XAxiDma_IntrDisable(&AxiDmaInstance, XAXIDMA_IRQ_ALL_MASK, XAXIDMA_DMA_TO_DEVICE);
		XAxiDma_IntrDisable(&AxiDmaInstance, XAXIDMA_IRQ_ALL_MASK, XAXIDMA_DEVICE_TO_DMA);

		Xil_DCacheEnable();//DcacheȷЧ

		if(data_rest >0){

			RxDone = 0;
			RX_BUFFER_BASE = RX_BUFFER_BASE + 0x3ff0000;

			if(data_rest > 0x3ff0000){
				ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,BYTES_Trans,0x3ff0000);//ͨѡ
				ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,SAMPLE_EN_GO,0x101);//ʹsample_enGo; bit[8]bit[0]
				start_trans_data(0x3ff0000, RX_BUFFER_BASE);
				data_rest = data_rest - 0x3ff0000;
			}
			else {
				ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,BYTES_Trans,data_rest);//ͨѡ
				ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,SAMPLE_EN_GO,0x101);//ʹsample_enGo; bit[8]bit[0]
				start_trans_data(data_rest, RX_BUFFER_BASE);
				data_rest = 0;
				RX_BUFFER_BASE = ADC_Data_Addr;
			}
		}
		else{
			ADC_SAMPLE_CTRL_0_mWriteReg(SAMPLE_CTRL_ADDR,SAMPLE_EN_GO,0);//õsample_enGo; bit[8]bit[0]
			buff = tcp_sndbuf(serpcb);
			if(buff >= send_data){
				tcp_write(serpcb,(void*)(0x1800000 + uiIdx),send_data,1);
				tcp_output(serpcb);
				RxDone = 0;
				send_data = 0;
				sample_send_flag = 0;
				uiIdx = 0;
				pbuf_free(serpcb->refused_data);
			}
			else{
				tcp_write(serpcb,(void*)(0x1800000 + uiIdx),buff,1);
				tcp_output(serpcb);
				send_data = send_data - buff;
				uiIdx += buff;
				pbuf_free(serpcb->refused_data);
			}
		}
	}
}

/************************************************************************************************************
**  @brief	ʼDMA
**  @param	len  ֽ
**  @param	RxBufferPtr  洢ݵʼַ
**  Sample:	start_trans_data(10240x1800000);//1024ֽݰ˵0x1800000Ϊʼַڴռ
************************************************************************************************************/
int start_trans_data(uint32_t len,UINTPTR RxBufferPtr)
{
	int Status;

	Xil_DCacheDisable();//dcacheȷһ
	/* Disable all interrupts before setup */

	XAxiDma_IntrDisable(&AxiDmaInstance, XAXIDMA_IRQ_ALL_MASK, XAXIDMA_DMA_TO_DEVICE);

	XAxiDma_IntrDisable(&AxiDmaInstance, XAXIDMA_IRQ_ALL_MASK, XAXIDMA_DEVICE_TO_DMA);

	XAxiDma_IntrEnable(&AxiDmaInstance, XAXIDMA_IRQ_ALL_MASK, XAXIDMA_DMA_TO_DEVICE);
//
	XAxiDma_IntrEnable(&AxiDmaInstance, XAXIDMA_IRQ_ALL_MASK, XAXIDMA_DEVICE_TO_DMA);

	/* Initialize flags before start transfer test  */
	RxDone = 0;
	Error = 0;

	Status = XAxiDma_SimpleTransfer(&AxiDmaInstance,RxBufferPtr,
			len, XAXIDMA_DEVICE_TO_DMA);

	if (Status != XST_SUCCESS) {
		return XST_FAILURE;
	}

	return XST_SUCCESS;
}
