rbuf.c

来自「LwIP adaptation for Fujitsu MB90f497 and」· C语言 代码 · 共 31 行

#include "lwip\rbuf.h"
struct rxbuf *rbuf_alloc() {
	struct rxbuf *rbuf;
	rbuf=mem_malloc(sizeof(struct rxbuf));
	if(rbuf!=NULL) {
		rbuf->pointer=rbuf->pdata;
	}
	return rbuf;
	}  



err_t rbuf_add(struct rxbuf* rbuf, struct pbuf *p) {
	if((rbuf_size(rbuf) + p->len) < MAX_RBUF) {
		bcopy(p->payload,rbuf->pointer,p->len);
		rbuf->pointer+=p->len;
//	 	mprintf(rbuf_size(rbuf),4,0);
	 	return ERR_OK;
	} else return ERR_MEM;
}

err_t rbuf_read(void *arg, struct rxbuf *rbuf, int c) {
int x;	
	if(rbuf_size(rbuf)<c) return ERR_ARG;
	bcopy(rbuf->pdata,arg,c);	
	for(x=0;x<rbuf_size(rbuf);x++) *(rbuf->pdata+x)=*(rbuf->pdata+c+x);
	rbuf->pointer-=c;
	return ERR_OK;
}