123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245 |
-
-
-
- #include "stddef.h"
- #include "string.h"
- #include "io.h"
- #include "errno.h"
- #include "buffer.h"
-
-
- void init_buffer ( struct buffer *buffer ) {
- char tail = 1;
-
- buffer->fill = 0;
- if ( buffer->end != buffer->start )
- copy_to_phys ( buffer->start, &tail, sizeof ( tail ) );
-
- DBG ( "BUFFER [%x,%x) initialised\n", buffer->start, buffer->end );
- }
-
-
- static void split_free_block ( struct buffer_free_block *desc,
- physaddr_t block, physaddr_t split ) {
-
- if ( split <= block )
- return;
-
-
- if ( split >= desc->end )
- return;
-
- DBG ( "BUFFER splitting [%x,%x) -> [%x,%x) [%x,%x)\n",
- block, desc->end, block, split, split, desc->end );
-
-
- copy_to_phys ( split, &desc->tail, sizeof ( desc->tail ) );
- if ( ! desc->tail )
- copy_to_phys ( split, desc, sizeof ( *desc ) );
-
-
- desc->tail = 0;
- desc->next_free = split;
- desc->end = split;
- copy_to_phys ( block, desc, sizeof ( *desc ) );
- }
-
-
- static inline void unfree_block ( struct buffer *buffer,
- struct buffer_free_block *desc,
- physaddr_t prev_block ) {
- struct buffer_free_block prev_desc;
-
-
- if ( ! prev_block ) {
- DBG ( "BUFFER marking [%x,%x) as used\n",
- buffer->start + buffer->fill, desc->end );
- buffer->fill = desc->next_free - buffer->start;
- return;
- }
-
-
- copy_from_phys ( &prev_desc, prev_block, sizeof ( prev_desc ) );
-
- DBG ( "BUFFER marking [%x,%x) as used\n",
- prev_desc.next_free, desc->end );
-
-
- prev_desc.next_free = desc->next_free;
- copy_to_phys ( prev_block, &prev_desc, sizeof ( prev_desc ) );
- }
-
-
- int fill_buffer ( struct buffer *buffer, const void *data,
- off_t offset, size_t len ) {
- struct buffer_free_block desc;
- physaddr_t block, prev_block;
- physaddr_t data_start, data_end;
-
-
- data_start = buffer->start + offset;
- data_end = data_start + len;
- DBG ( "BUFFER [%x,%x) writing portion [%x,%x)\n",
- buffer->start, buffer->end, data_start, data_end );
-
-
- if ( data_end > buffer->end ) {
- DBG ( "BUFFER [%x,%x) too small for data!\n",
- buffer->start, buffer->end );
- errno = ENOMEM;
- return 0;
- }
-
-
- prev_block = 0;
- block = buffer->start + buffer->fill;
- while ( block < buffer->end ) {
-
- desc.next_free = buffer->end;
- desc.end = buffer->end;
- copy_from_phys ( &desc.tail, block, sizeof ( desc.tail ) );
- if ( ! desc.tail )
- copy_from_phys ( &desc, block, sizeof ( desc ) );
-
-
- split_free_block ( &desc, block, data_start );
- split_free_block ( &desc, block, data_end );
-
-
-
- if ( ( block >= data_start ) && ( block < data_end ) ) {
-
- unfree_block ( buffer, &desc, prev_block );
- copy_to_phys ( block, data + ( block - data_start ),
- desc.end - block );
- } else {
-
- prev_block = block;
- }
-
-
- block = desc.next_free;
- }
-
- DBG ( "BUFFER [%x,%x) full up to %x\n",
- buffer->start, buffer->end, buffer->start + buffer->fill );
-
- return 1;
- }
|