|  | @@ -40,7 +40,7 @@ FILE_LICENCE ( GPL2_OR_LATER );
 | 
		
	
		
			
			| 40 | 40 |   * @c IOBUF_SIZE.
 | 
		
	
		
			
			| 41 | 41 |   */
 | 
		
	
		
			
			| 42 | 42 |  struct io_buffer * alloc_iob ( size_t len ) {
 | 
		
	
		
			
			| 43 |  | -	struct io_buffer *iobuf = NULL;
 | 
		
	
		
			
			|  | 43 | +	struct io_buffer *iobuf;
 | 
		
	
		
			
			| 44 | 44 |  	size_t align;
 | 
		
	
		
			
			| 45 | 45 |  	void *data;
 | 
		
	
		
			
			| 46 | 46 |  
 | 
		
	
	
		
			
			|  | @@ -57,14 +57,37 @@ struct io_buffer * alloc_iob ( size_t len ) {
 | 
		
	
		
			
			| 57 | 57 |  	 */
 | 
		
	
		
			
			| 58 | 58 |  	align = ( 1 << fls ( len - 1 ) );
 | 
		
	
		
			
			| 59 | 59 |  
 | 
		
	
		
			
			| 60 |  | -	/* Allocate memory for buffer plus descriptor */
 | 
		
	
		
			
			| 61 |  | -	data = malloc_dma ( len + sizeof ( *iobuf ), align );
 | 
		
	
		
			
			| 62 |  | -	if ( ! data )
 | 
		
	
		
			
			| 63 |  | -		return NULL;
 | 
		
	
		
			
			|  | 60 | +	/* Allocate buffer plus descriptor as a single unit, unless
 | 
		
	
		
			
			|  | 61 | +	 * doing so will push the total size over the alignment
 | 
		
	
		
			
			|  | 62 | +	 * boundary.
 | 
		
	
		
			
			|  | 63 | +	 */
 | 
		
	
		
			
			|  | 64 | +	if ( ( len + sizeof ( *iobuf ) ) <= align ) {
 | 
		
	
		
			
			|  | 65 | +
 | 
		
	
		
			
			|  | 66 | +		/* Allocate memory for buffer plus descriptor */
 | 
		
	
		
			
			|  | 67 | +		data = malloc_dma ( len + sizeof ( *iobuf ), align );
 | 
		
	
		
			
			|  | 68 | +		if ( ! data )
 | 
		
	
		
			
			|  | 69 | +			return NULL;
 | 
		
	
		
			
			|  | 70 | +		iobuf = ( data + len );
 | 
		
	
		
			
			|  | 71 | +
 | 
		
	
		
			
			|  | 72 | +	} else {
 | 
		
	
		
			
			|  | 73 | +
 | 
		
	
		
			
			|  | 74 | +		/* Allocate memory for buffer */
 | 
		
	
		
			
			|  | 75 | +		data = malloc_dma ( len, align );
 | 
		
	
		
			
			|  | 76 | +		if ( ! data )
 | 
		
	
		
			
			|  | 77 | +			return NULL;
 | 
		
	
		
			
			| 64 | 78 |  
 | 
		
	
		
			
			| 65 |  | -	iobuf = ( struct io_buffer * ) ( data + len );
 | 
		
	
		
			
			|  | 79 | +		/* Allocate memory for descriptor */
 | 
		
	
		
			
			|  | 80 | +		iobuf = malloc ( sizeof ( *iobuf ) );
 | 
		
	
		
			
			|  | 81 | +		if ( ! iobuf ) {
 | 
		
	
		
			
			|  | 82 | +			free_dma ( data, len );
 | 
		
	
		
			
			|  | 83 | +			return NULL;
 | 
		
	
		
			
			|  | 84 | +		}
 | 
		
	
		
			
			|  | 85 | +	}
 | 
		
	
		
			
			|  | 86 | +
 | 
		
	
		
			
			|  | 87 | +	/* Populate descriptor */
 | 
		
	
		
			
			| 66 | 88 |  	iobuf->head = iobuf->data = iobuf->tail = data;
 | 
		
	
		
			
			| 67 |  | -	iobuf->end = iobuf;
 | 
		
	
		
			
			|  | 89 | +	iobuf->end = ( data + len );
 | 
		
	
		
			
			|  | 90 | +
 | 
		
	
		
			
			| 68 | 91 |  	return iobuf;
 | 
		
	
		
			
			| 69 | 92 |  }
 | 
		
	
		
			
			| 70 | 93 |  
 | 
		
	
	
		
			
			|  | @@ -75,12 +98,29 @@ struct io_buffer * alloc_iob ( size_t len ) {
 | 
		
	
		
			
			| 75 | 98 |   * @v iobuf	I/O buffer
 | 
		
	
		
			
			| 76 | 99 |   */
 | 
		
	
		
			
			| 77 | 100 |  void free_iob ( struct io_buffer *iobuf ) {
 | 
		
	
		
			
			| 78 |  | -	if ( iobuf ) {
 | 
		
	
		
			
			| 79 |  | -		assert ( iobuf->head <= iobuf->data );
 | 
		
	
		
			
			| 80 |  | -		assert ( iobuf->data <= iobuf->tail );
 | 
		
	
		
			
			| 81 |  | -		assert ( iobuf->tail <= iobuf->end );
 | 
		
	
		
			
			| 82 |  | -		free_dma ( iobuf->head,
 | 
		
	
		
			
			| 83 |  | -			   ( iobuf->end - iobuf->head ) + sizeof ( *iobuf ) );
 | 
		
	
		
			
			|  | 101 | +	size_t len;
 | 
		
	
		
			
			|  | 102 | +
 | 
		
	
		
			
			|  | 103 | +	/* Allow free_iob(NULL) to be valid */
 | 
		
	
		
			
			|  | 104 | +	if ( ! iobuf )
 | 
		
	
		
			
			|  | 105 | +		return;
 | 
		
	
		
			
			|  | 106 | +
 | 
		
	
		
			
			|  | 107 | +	/* Sanity checks */
 | 
		
	
		
			
			|  | 108 | +	assert ( iobuf->head <= iobuf->data );
 | 
		
	
		
			
			|  | 109 | +	assert ( iobuf->data <= iobuf->tail );
 | 
		
	
		
			
			|  | 110 | +	assert ( iobuf->tail <= iobuf->end );
 | 
		
	
		
			
			|  | 111 | +
 | 
		
	
		
			
			|  | 112 | +	/* Free buffer */
 | 
		
	
		
			
			|  | 113 | +	len = ( iobuf->end - iobuf->head );
 | 
		
	
		
			
			|  | 114 | +	if ( iobuf->end == iobuf ) {
 | 
		
	
		
			
			|  | 115 | +
 | 
		
	
		
			
			|  | 116 | +		/* Descriptor is inline */
 | 
		
	
		
			
			|  | 117 | +		free_dma ( iobuf->head, ( len + sizeof ( *iobuf ) ) );
 | 
		
	
		
			
			|  | 118 | +
 | 
		
	
		
			
			|  | 119 | +	} else {
 | 
		
	
		
			
			|  | 120 | +
 | 
		
	
		
			
			|  | 121 | +		/* Descriptor is detached */
 | 
		
	
		
			
			|  | 122 | +		free_dma ( iobuf->head, len );
 | 
		
	
		
			
			|  | 123 | +		free ( iobuf );
 | 
		
	
		
			
			| 84 | 124 |  	}
 | 
		
	
		
			
			| 85 | 125 |  }
 | 
		
	
		
			
			| 86 | 126 |  
 |