#include <stdint.h>
#include "tl2cdr.h"

#ifndef TL2CDR_BASE
#error TL2CDR Base address not define!!!
#endif

volatile uint32_t *cdr_status = (uint32_t*)( TL2CDR_BASE + CDR_ReadStatus ); //read
volatile uint32_t *cdr_txLen  = (uint32_t*)( TL2CDR_BASE + CDR_WriteTxLen ); //write
volatile uint32_t *cdr_txFifo = (uint32_t*)( TL2CDR_BASE + CDR_WriteTxFifo ); //write
volatile uint32_t *cdr_direct = (uint32_t*)( TL2CDR_BASE + CDR_WriteTransDir ); //write

volatile uint32_t *cdr_softReset = (uint32_t*)( TL2CDR_BASE + CDR_WriteSoftReset ); //write
volatile uint32_t *cdr_rxLen     = (uint32_t*)( TL2CDR_BASE + CDR_ReadRxLen ); //read
volatile uint32_t *cdr_rxFifo    = (uint32_t*)( TL2CDR_BASE + CDR_ReadRxFifo ); //read

void cdr_set_downStream(){
	*cdr_softReset = 1; //复位脉冲
	*cdr_direct = 0;
}

void cdr_set_upStream(){
	*cdr_softReset = 1; //复位脉冲
	*cdr_direct = 1;
}


void cdr_simple_tx( uint32_t txLen, uint8_t operator, uint8_t* data){
	//发送下行包头
	assert(txLen < 2^12);
	assert(txLen > 8 );
	assert(txLen % 4 == 0 );
	assert(operator < 2^4);

	*cdr_txLen = txLen;
	*cdr_txFifo = (uint32_t)( txLen << 20) | ( operator << 16) | 0x0000;
	*cdr_txFifo = (uint32_t)0x00;

	for( uint32_t i = 0; i < (txLen-8)/4; i ++ ){
		*cdr_txFifo = data[4*i+3]<< 24 | data[4*i+2]<<16 | data[4*i+1]<< 8 | data[4*i+0] << 0;
	}



}


uint32_t cdr_wait_tx_finish(){
	// //等待发送完成标志
	// asm volatile (
	// 	"1:\n"
	// 	"andi %0, sp, 0x01\n"
	// 	"beqz %0, 1b\n"
	// 	"andi sp, sp, 0xFE\n"
	// 	:"+r"(flag)
	// );	
}

uint32_t cdr_wait_rx_start(){
	//接收第一个包
	asm volatile (
		"1:\n"
		"andi %0, sp, 0x04\n"
		"beqz %0, 1b\n"
		"andi sp, sp, 0xFB\n"
		:"+r"(flag)
	);	
}

uint32_t cdr_check_rx_fail(){

}

void cdr_simple_rx(uint32_t* rxLen, uint8_t* operator, uint8_t* data){


	uint32_t readDat;

	readDat = *cdr_rxFifo;	
	&operator = (readDat >> 16) & 0xf;
	&rxLen    = readDat >> 20;
	readDat = *cdr_rxFifo;

	for( uint32_t i = 0; i < (&rxLen >> 2); i ++ ){ //一次传4byte
		readDat = *cdr_rxFifo;
		data[4*i+1] = (uint8_t)( (readDat >>  0) & 0xFF);
		data[4*i+0] = (uint8_t)( (readDat >>  8) & 0xFF);
		data[4*i+2] = (uint8_t)( (readDat >> 16) & 0xFF);
		data[4*i+3] = (uint8_t)( (readDat >> 24) & 0xFF);
	}

	//CRC
	uint32_t crc = *cdr_rxFifo; //CRC

}


void cdr_slave_function(){
	
}