T536_DTU/app_public/fuxi_public/fuxi_bsp/source/mb.c

/******************************************************************************
版权所有：	文件名称：	mb.c
文件名称：	mb.c
文件版本：	01.01
创建作者：	sunxi
创建日期：	2022-05-17
功能说明：	邮箱驱动
其它说明：
修改记录：
*/
#include "bspconfig.h"
#include "bsp.h"
#include "mb.h"

#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <string.h>
#include <fcntl.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <pthread.h>
#include <stdbool.h>

#define CO_IOCTL_GET_REG	1
#define CO_IOCTL_SET_REG	2
#define CO_IOCTL_EXECUTE	3
#define CO_IOCTL_GET_DATA	4
#define CO_IOCTL_SET_DATA	5
#define CO_IOCTL_GET_CONFIGS	6
#define CO_IOCTL_SET_PC		7

#ifndef CO_MB_FIFO_SIZE
#define CO_MB_FIFO_SIZE		32//经测试，只能这么大的buf
#endif

struct co_io {
	uint8_t meta;
	uint16_t metadata;
	uint32_t data[CO_MB_FIFO_SIZE - 1];
	uint8_t len;
};

struct mb_co {
    char                    *name;
    pthread_t               thread_id;
    int                     fd_co; 
    struct co_io            coio;
};

static struct mb_co *pmb;


static inline void dmsg_u8(uint8_t *data, int length, char *str)
{
	int i, j;
	int tmp;

	printf("%s:\n", str);
	for (i = 0; i < (length / 16); i++)
	{
		for (j = 0; j < 16; j++)
			printf("%02x ", data[i * 16 + j]);
		printf("\n");
	}
	tmp = (length / 16) * 16;
	for (i = 0; i < (length % 16); i++)
		printf("%02x ", data[tmp + i]);
	if (length % 16)
		printf("\n");
}


/******************************************************************************
函数名称：	mb_write
函数版本：	01.01
创建作者：	sunxi
创建日期：	2022-05-17
函数说明：	向邮箱写入数据.
参数说明：	
cmd：命令号
data：写入数据
len:写入数据长度，注意： 如果转入2个uint32_t的数据，那么长度为2，不是8.

返回值：	成功返回0, 失败返回-1
修改记录：	

！！！！！！！！！ 注意： 如果转入2个uint32_t的数据，那么长度为2，不是8.

*/
int mb_write(uint16_t cmd, uint32_t *data, uint8_t len)
{
	return 0;//noted by ygl: 邮箱功能暂时不实现 
	int i;
	int ret;
	struct mb_co *co = NULL;

	if(pmb == NULL)
		return -1;

	if(data == NULL)
		return -1;

	if(len > (CO_MB_FIFO_SIZE - 1))
		return -1;

	co = pmb;

	for (i = 0; i < len; i++)
	   co->coio.data[i] = data[i];

/*
meta =0时，metadata无效，对方收不到metadata值。
meta =为非0时，metadata置数，对方也收到metadata值。
*/
	/* ipc message parameters */
	co->coio.meta = 1;//noted by sunxi: 与裸核，约定为1
	co->coio.metadata = cmd;
	co->coio.len = len;

#if 0	
	for (i = 0; i < co->coio.len; i++)
		printf("%04X ", co->coio.data[i]);
	printf("\r\n");
#endif
	
	ret = ioctl(co->fd_co, CO_IOCTL_SET_DATA, &co->coio);
	if (ret)
		printf("send to %s failed, ret = %d\n",co->name, ret);

	return 0;
}


/******************************************************************************
函数名称：	mb_notice_time_update
函数版本：	01.01
创建作者：	sunxi
创建日期：	2022-05-17
函数说明：	用邮箱告知时间更新了
参数说明：	

返回值：	成功返回0, 失败返回-1
修改记录：	

*/
int mb_notice_time_update(void)
{

    int ret;
	uint32_t data[31];

	data[0] = MB_CMD_TIME;
	data[1] = MB_CMD_TIME;

	ret = mb_write(MB_CMD_TIME, data, 2);
	if(ret<0)
		printf("mb_write fail!!! ret= %d\n", ret);

	return ret;
}

/******************************************************************************
函数名称：	mb_notice_freqTr_update
函数版本：	01.01
创建作者：	sunxi
创建日期：	2022-05-17
函数说明：	用邮箱告知频率跟踪更新了
参数说明：	

返回值：	成功返回0, 失败返回-1
修改记录：	

*/
int mb_notice_freqTr_update(void)
{

    int ret;
	uint32_t data[31];

	data[0] = MB_CMD_FREQTR;
	data[1] = MB_CMD_FREQTR;

	ret = mb_write(MB_CMD_FREQTR, data, 2);
	if(ret<0)
		printf("mb_write fail!!! ret= %d\n", ret);

	return ret;
}

/******************************************************************************
函数名称：	mb_notice_RfV_update
函数版本：	01.01
创建作者：	sunxi
创建日期：	2022-05-17
函数说明：	用邮箱告知AD7616参考电压范围更新了
参数说明：	
no：第n片7616

返回值：	成功返回0, 失败返回-1
修改记录：	

*/
int mb_notice_RfV_update(uint8_t no)
{

    int ret;
	uint32_t data[31];

	data[0] = no;
	data[1] = no;

	ret = mb_write(MB_CMD_RfV, data, 2);
	if(ret<0)
		printf("mb_write fail!!! ret= %d\n", ret);

	return ret;
}


static int co_mb_open(struct mb_co *co, char *name)
{
    int fd_co;


    printf("open co mb dev %s\n", name);

    fd_co = open(name, O_RDWR);
    if (!fd_co) {
        printf("open co dev failed\n");
        return -1;	
    }

    co->name  = name;
    co->fd_co = fd_co;


	return 0;

}


static void *thread_co_test(void *arg)
{
    struct mb_co *co = pmb;
    //int i;
    int ret;


    
    while (1) {

	  sleep(1);

#if 0	  
	  crc++;
  
		 for (i = 0; i < (CO_MB_FIFO_SIZE - 1); i++)
			data[i] = i+crc;

		ret = mb_write(MB_CMD_TIME, data, 31);
		if(ret<0)
			printf("send to %s failed, ret = %d\n",co->name, ret);

#endif

		ret = mb_notice_time_update();
		if(ret<0)
			printf("send to %s failed, ret = %d\n",co->name, ret);	  


	  
    }
    printf("thread co exit\r\n");    
    pthread_exit(NULL);
}


//测试代码
void mb_test(void)
{
	int ret;
	
	if((ret = pthread_create(&pmb->thread_id, NULL, thread_co_test, pmb)) == 0)
		printf("thread co0 create success\r\n");
	else
		printf("thread co0 create fail ret=%d\r\n", ret);

}



/******************************************************************************
函数名称：	mb_init
函数版本：	01.01
创建作者：	sunxi
创建日期：	2022-05-17
函数说明：	mb初始化.
参数说明：	
					无					
返回值：	成功返回0, 失败返回-1
修改记录：	
*/
int mb_init(void)
{
//	int ret;
	pmb = malloc(sizeof(struct mb_co));

	memset(pmb, 0, sizeof(struct mb_co));


	if(co_mb_open(pmb, "/dev/arv-shmem")) {
		printf("open mb error\r\n");
		return -1;
	}

	
	//mb_test();//sunxi for test


	

	return 0;	
}

/******************************************************************************
函数名称：	mb_exit
函数版本：	01.01
创建作者：	sunxi
创建日期：	2022-05-17
函数说明：	mb反初始化.
参数说明：	
					无					
返回值：	总是返回0.
修改记录：	
*/
int mb_exit(void)
{
	if(pmb)
	{
		if(pmb->fd_co)
		 	close(pmb->fd_co);
	}

	return 0;
}