net: zynq_gem: Use shared wait_for_bit
Use existing library function to poll bit(s). Signed-off-by: Mateusz Kulikowski <mateusz.kulikowski@gmail.com>
This commit is contained in:
parent
8c25c2592e
commit
e7138b34b0
@ -19,6 +19,7 @@
|
|||||||
#include <asm/io.h>
|
#include <asm/io.h>
|
||||||
#include <phy.h>
|
#include <phy.h>
|
||||||
#include <miiphy.h>
|
#include <miiphy.h>
|
||||||
|
#include <wait_bit.h>
|
||||||
#include <watchdog.h>
|
#include <watchdog.h>
|
||||||
#include <asm/system.h>
|
#include <asm/system.h>
|
||||||
#include <asm/arch/hardware.h>
|
#include <asm/arch/hardware.h>
|
||||||
@ -448,38 +449,6 @@ static int zynq_gem_init(struct udevice *dev)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int wait_for_bit(const char *func, u32 *reg, const u32 mask,
|
|
||||||
bool set, unsigned int timeout)
|
|
||||||
{
|
|
||||||
u32 val;
|
|
||||||
unsigned long start = get_timer(0);
|
|
||||||
|
|
||||||
while (1) {
|
|
||||||
val = readl(reg);
|
|
||||||
|
|
||||||
if (!set)
|
|
||||||
val = ~val;
|
|
||||||
|
|
||||||
if ((val & mask) == mask)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
if (get_timer(start) > timeout)
|
|
||||||
break;
|
|
||||||
|
|
||||||
if (ctrlc()) {
|
|
||||||
puts("Abort\n");
|
|
||||||
return -EINTR;
|
|
||||||
}
|
|
||||||
|
|
||||||
udelay(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
debug("%s: Timeout (reg=%p mask=%08x wait_set=%i)\n",
|
|
||||||
func, reg, mask, set);
|
|
||||||
|
|
||||||
return -ETIMEDOUT;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int zynq_gem_send(struct udevice *dev, void *ptr, int len)
|
static int zynq_gem_send(struct udevice *dev, void *ptr, int len)
|
||||||
{
|
{
|
||||||
u32 addr, size;
|
u32 addr, size;
|
||||||
@ -521,7 +490,7 @@ static int zynq_gem_send(struct udevice *dev, void *ptr, int len)
|
|||||||
printf("TX buffers exhausted in mid frame\n");
|
printf("TX buffers exhausted in mid frame\n");
|
||||||
|
|
||||||
return wait_for_bit(__func__, ®s->txsr, ZYNQ_GEM_TSR_DONE,
|
return wait_for_bit(__func__, ®s->txsr, ZYNQ_GEM_TSR_DONE,
|
||||||
true, 20000);
|
true, 20000, true);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Do not check frame_recd flag in rx_status register 0x20 - just poll BD */
|
/* Do not check frame_recd flag in rx_status register 0x20 - just poll BD */
|
||||||
|
Loading…
Reference in New Issue
Block a user