Blame view

common/bouncebuf.c 1.89 KB
83d290c56   Tom Rini   SPDX: Convert all...
1
  // SPDX-License-Identifier: GPL-2.0+
b660df3c9   Marek Vasut   COMMON: Implement...
2
3
4
5
  /*
   * Generic bounce buffer implementation
   *
   * Copyright (C) 2012 Marek Vasut <marex@denx.de>
b660df3c9   Marek Vasut   COMMON: Implement...
6
7
8
9
10
11
   */
  
  #include <common.h>
  #include <malloc.h>
  #include <errno.h>
  #include <bouncebuf.h>
84d35b286   Stephen Warren   common: rework bo...
12
  static int addr_aligned(struct bounce_buffer *state)
b660df3c9   Marek Vasut   COMMON: Implement...
13
14
15
16
  {
  	const ulong align_mask = ARCH_DMA_MINALIGN - 1;
  
  	/* Check if start is aligned */
84d35b286   Stephen Warren   common: rework bo...
17
18
19
  	if ((ulong)state->user_buffer & align_mask) {
  		debug("Unaligned buffer address %p
  ", state->user_buffer);
b660df3c9   Marek Vasut   COMMON: Implement...
20
21
  		return 0;
  	}
84d35b286   Stephen Warren   common: rework bo...
22
23
  	/* Check if length is aligned */
  	if (state->len != state->len_aligned) {
5d69a5d17   Vasili Galka   Fix a few printf ...
24
25
  		debug("Unaligned buffer length %zu
  ", state->len);
b660df3c9   Marek Vasut   COMMON: Implement...
26
27
28
29
30
31
  		return 0;
  	}
  
  	/* Aligned */
  	return 1;
  }
84d35b286   Stephen Warren   common: rework bo...
32
33
  int bounce_buffer_start(struct bounce_buffer *state, void *data,
  			size_t len, unsigned int flags)
b660df3c9   Marek Vasut   COMMON: Implement...
34
  {
84d35b286   Stephen Warren   common: rework bo...
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
  	state->user_buffer = data;
  	state->bounce_buffer = data;
  	state->len = len;
  	state->len_aligned = roundup(len, ARCH_DMA_MINALIGN);
  	state->flags = flags;
  
  	if (!addr_aligned(state)) {
  		state->bounce_buffer = memalign(ARCH_DMA_MINALIGN,
  						state->len_aligned);
  		if (!state->bounce_buffer)
  			return -ENOMEM;
  
  		if (state->flags & GEN_BB_READ)
  			memcpy(state->bounce_buffer, state->user_buffer,
  				state->len);
b660df3c9   Marek Vasut   COMMON: Implement...
50
  	}
84d35b286   Stephen Warren   common: rework bo...
51
52
53
54
55
56
57
  	/*
  	 * Flush data to RAM so DMA reads can pick it up,
  	 * and any CPU writebacks don't race with DMA writes
  	 */
  	flush_dcache_range((unsigned long)state->bounce_buffer,
  				(unsigned long)(state->bounce_buffer) +
  					state->len_aligned);
b660df3c9   Marek Vasut   COMMON: Implement...
58
59
60
  
  	return 0;
  }
84d35b286   Stephen Warren   common: rework bo...
61
  int bounce_buffer_stop(struct bounce_buffer *state)
b660df3c9   Marek Vasut   COMMON: Implement...
62
  {
84d35b286   Stephen Warren   common: rework bo...
63
64
65
66
67
68
  	if (state->flags & GEN_BB_WRITE) {
  		/* Invalidate cache so that CPU can see any newly DMA'd data */
  		invalidate_dcache_range((unsigned long)state->bounce_buffer,
  					(unsigned long)(state->bounce_buffer) +
  						state->len_aligned);
  	}
b660df3c9   Marek Vasut   COMMON: Implement...
69

84d35b286   Stephen Warren   common: rework bo...
70
  	if (state->bounce_buffer == state->user_buffer)
b660df3c9   Marek Vasut   COMMON: Implement...
71
  		return 0;
84d35b286   Stephen Warren   common: rework bo...
72
73
  	if (state->flags & GEN_BB_WRITE)
  		memcpy(state->user_buffer, state->bounce_buffer, state->len);
b660df3c9   Marek Vasut   COMMON: Implement...
74

84d35b286   Stephen Warren   common: rework bo...
75
  	free(state->bounce_buffer);
b660df3c9   Marek Vasut   COMMON: Implement...
76
77
78
  
  	return 0;
  }