예제 #1
0
int pingpang_buffer_read(struct modem_buffer *buffer,char *data,int size)
{
	int read_len = 0;
	int data_size = 0;
	int i;
	int read_point= buffer->buffer[0].read_point;

	if (buffer->type==BUF_RECV) {
		do{
			if (buffer->buffer[0].write_point != buffer->buffer[0].read_point)
				break;
			down(&buffer->buf_read_sem);
		}while(1);
		data_size = buffer_data_size(&buffer->buffer[0]);
		if(data_size==0)
			return 0;

		if(data_size < size){
			read_len = data_size;
		} else {
			read_len = size;
		}
		for (i=0;i<read_len;i++) {
			data[i]= buffer->buffer[0].addr[read_point++];
			if(read_point >= buffer->buffer[0].size)
				read_point = 0;
		}
		dloader_record_timestamp(0x30000000|buffer->buffer[0].read_point);
		dloader_record_timestamp(0x40000000|read_point);
		buffer->buffer[0].read_point = read_point;
		up(&buffer->buf_read_sem);
		return read_len;
	}
	return 0;
}
int save_to_receive_buffer(struct modem_buffer *buffer,char *data,int size)
{
	int free_space = 0;	
	int data_size = 0;
	int i;
	int write_point= buffer->buffer[0].write_point;

	if (buffer->type==BUF_RECV) {
		do{
			data_size = buffer_data_size(&buffer->buffer[0]);	
			free_space = buffer->buffer[0].size-1-data_size;
			if (free_space >= size)
				break;
			down(&buffer->buf_read_sem);
		}while(1);
		for(i=0;i<size;i++){
			buffer->buffer[0].addr[write_point++]=data[i];
			if(write_point >= buffer->buffer[0].size)
				write_point = 0;
		}
		buffer->buffer[0].write_point = write_point;
		up(&buffer->buf_read_sem);
		return size;
	}
	return 0;
}
예제 #3
0
int pingpang_buffer_write(struct modem_buffer *buffer,char *data,int size)
{
	int index = 0;
	int data_size;
	int free_space;
	int write_point;
	int save_flag = 0;
	int i;
	unsigned long flags;
	enum BUF_status_t status;

	if(buffer->type == BUF_SEND){
		if (size >= buffer->buffer[0].size)
			return 0;

		do{
			index = buffer->save_index;
			for(i=0;i<2;i++){
				local_irq_save(flags);
				status = buffer->buffer[index].status;
				if ((status != BUF_STATUS_SENT) &&
				    (status != BUF_STATUS_FULL) &&
				    (status != BUF_STATUS_WRITTEN)) {
					buffer->buffer[index].status = BUF_STATUS_WRITTEN;
					local_irq_restore(flags);
					data_size = buffer_data_size(&buffer->buffer[index]);
					free_space = buffer->buffer[index].size -1 - data_size;
					if(free_space < size){
						buffer->buffer[index].status = BUF_STATUS_FULL;
						if(buffer->trans_index == 0xFF)
							buffer->trans_index = index;
						index = 1 - index;
						buffer->save_index = index;
					} else {
						write_point = buffer->buffer[index].write_point;
						for(i=0;i<size;i++){
							buffer->buffer[index].addr[write_point++]=data[i];
							if(write_point >= buffer->buffer[index].size)
								write_point = 0;
						}
						dloader_record_timestamp(0x10000000|(index<<24)|buffer->buffer[index].write_point);
						dloader_record_timestamp(0x20000000|(index<<24)|write_point);
						buffer->buffer[index].write_point = write_point;
						buffer->buffer[index].status = BUF_STATUS_NOEMPTY;
						buffer->buffer[index].status = BUF_STATUS_FULL;
						if(buffer->trans_index == 0xFF)
							buffer->trans_index = index;
						save_flag = 1;
					}
				} else {
					local_irq_restore(flags);
					index = 1 - index;
				}
			}
			if(save_flag==0)
				down(&buffer->buf_write_sem);
		}while(save_flag == 0);
	}
	return size;
}
int pingpang_buffer_read(struct modem_buffer *buffer,char __user *data,int size)
{
	int read_len = 0;
	int data_size = 0;	
	int i;
	int read_point= buffer->buffer[0].read_point;

	if (buffer->type==BUF_RECV) {
		do{
			if (buffer->buffer[0].write_point != buffer->buffer[0].read_point)
				break;
			down(&buffer->buf_read_sem);
		}while(1);

		data_size = buffer_data_size(&buffer->buffer[0]);

		if(data_size==0)
			return 0;

		if(data_size < size){
			read_len = data_size;
		} else {
			read_len = size;
		}
                if(copy_to_user(data,&buffer->buffer[0].addr[read_point],read_len)){
			printk("copy_to_user(%d,%d,%d) failed\n",read_len,size,data_size);
                        up(&buffer->buf_read_sem);
                        return -EFAULT;
                }

		buffer->buffer[0].read_point = 0; 
		buffer->buffer[0].write_point = 0; 
		up(&buffer->buf_read_sem);
		return read_len;
	}
	return 0;
}