lanparams.c

AVR读写CF卡的应用例子

#include <atmega128.h>
#include <ina90.h>
#include <string.h>
#include <__debug_stdio.h>
#include "LANParams.h"



void initNetworkParameters(NetworkParameters *params)
{
	params->length=0;
	params->pos=0;
}

unsigned char addNetworkParameter(NetworkParameters *params,unsigned char paramCode,unsigned char length,unsigned char *data)
{
	unsigned char i,l;
	
	l=params->length;
	if(l+2+length>MAX_PARAMS) return 0; // overflow
	
	
	params->data[l++]=paramCode;
	params->data[l++]=length;
	for(i=0;i<length;i++) params->data[l++]=data[i];
	params->length=l;
	return 1;
}

void resetNetworkParameters(NetworkParameters *params)
{
	params->pos=0;
}

unsigned char getNextNetworkParameter(NetworkParameters *params,unsigned char *paramCode,unsigned char *length,unsigned char *data)
{
	unsigned char i,p;
	
	p=params->pos;
	if(p>=params->length) return 0;
	
	*paramCode=params->data[p++];
	*length=params->data[p++];
	for(i=0;i<*length;i++) data[i]=params->data[p++];
	params->pos=p;
	return 1;
}

unsigned char getNextLabelledNetworkParameter(NetworkParameters *params,unsigned char paramCode,unsigned char *length,unsigned char *data)
{
	unsigned char code;
	
	while(getNextNetworkParameter(params,&code,length,data))
	{
		if(code==paramCode) return 1;
	}
	return 0;
}