get_cnfg.c

来自「fx2 gpif sigleread 方式可手动修正数据方式传送固件」· C语言 代码 · 共 24 行

#include <stdio.h>
#include "..\inc\ezusb.h"

CONFIGDSCR xdata *	EZUSB_GetConfigDscr(BYTE ConfigIdx)
{
	BYTE		index = 0;
	WORD		length;
	CONFIGDSCR	xdata *dscr;

	dscr = (CONFIGDSCR	xdata *) pConfigDscr;

	while(dscr->type == CONFIG_DSCR)
	{
		 if(index++ == ConfigIdx)
			return(dscr);
		length = dscr->config_len;
		SWAP_ENDIAN(length);
		dscr = (CONFIGDSCR xdata *)((WORD)dscr + length);
	}

	return(NULL);
}