Add a driver for RXAUI control on IHS FPGAs. Signed-off-by: Mario Six <mario.six@gdsys.cc> Reviewed-by: Simon Glass <sjg@chromium.org>lime2-spi
parent
f0bcbe6c18
commit
86da8c12ef
@ -0,0 +1,76 @@ |
||||
// SPDX-License-Identifier: GPL-2.0+
|
||||
/*
|
||||
* (C) Copyright 2015 |
||||
* Dirk Eibach, Guntermann & Drunck GmbH, eibach@gdsys.de |
||||
* |
||||
* (C) Copyright 2017 |
||||
* Mario Six, Guntermann & Drunck GmbH, mario.six@gdsys.cc |
||||
*/ |
||||
|
||||
#include <common.h> |
||||
#include <dm.h> |
||||
#include <regmap.h> |
||||
#include <misc.h> |
||||
|
||||
struct gdsys_rxaui_ctrl_regs { |
||||
u16 gen_cnt; |
||||
u16 err_cnt; |
||||
u16 succ_cnt; |
||||
u16 status; |
||||
u16 ctrl_0; |
||||
u16 ctrl_1; |
||||
}; |
||||
|
||||
#define rxaui_ctrl_set(map, member, val) \ |
||||
regmap_set(map, struct gdsys_rxaui_ctrl_regs, member, val) |
||||
|
||||
#define rxaui_ctrl_get(map, member, valp) \ |
||||
regmap_get(map, struct gdsys_rxaui_ctrl_regs, member, valp) |
||||
|
||||
struct gdsys_rxaui_ctrl_priv { |
||||
struct regmap *map; |
||||
}; |
||||
|
||||
int gdsys_rxaui_set_polarity_inversion(struct udevice *dev, bool val) |
||||
{ |
||||
struct gdsys_rxaui_ctrl_priv *priv = dev_get_priv(dev); |
||||
u16 state; |
||||
|
||||
rxaui_ctrl_get(priv->map, ctrl_1, &state); |
||||
|
||||
if (val) |
||||
state |= ~0x7800; |
||||
else |
||||
state &= ~0x7800; |
||||
|
||||
rxaui_ctrl_set(priv->map, ctrl_1, state); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static const struct misc_ops gdsys_rxaui_ctrl_ops = { |
||||
.set_enabled = gdsys_rxaui_set_polarity_inversion, |
||||
}; |
||||
|
||||
int gdsys_rxaui_ctrl_probe(struct udevice *dev) |
||||
{ |
||||
struct gdsys_rxaui_ctrl_priv *priv = dev_get_priv(dev); |
||||
|
||||
regmap_init_mem(dev, &priv->map); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static const struct udevice_id gdsys_rxaui_ctrl_ids[] = { |
||||
{ .compatible = "gdsys,rxaui_ctrl" }, |
||||
{ } |
||||
}; |
||||
|
||||
U_BOOT_DRIVER(gdsys_rxaui_ctrl) = { |
||||
.name = "gdsys_rxaui_ctrl", |
||||
.id = UCLASS_MISC, |
||||
.ops = &gdsys_rxaui_ctrl_ops, |
||||
.of_match = gdsys_rxaui_ctrl_ids, |
||||
.probe = gdsys_rxaui_ctrl_probe, |
||||
.priv_auto_alloc_size = sizeof(struct gdsys_rxaui_ctrl_priv), |
||||
}; |
Loading…
Reference in new issue