#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/iopoll.h>
#include <linux/mii.h>
#include <linux/platform_device.h>
#include <linux/of_net.h>
#include "ks8851.h"
static int msg_enable;
#define BE3 0x8000 /* Byte Enable 3 */
#define BE2 0x4000 /* Byte Enable 2 */
#define BE1 0x2000 /* Byte Enable 1 */
#define BE0 0x1000 /* Byte Enable 0 */
struct ks8851_net_par {
struct ks8851_net ks8851;
spinlock_t lock;
void __iomem *hw_addr;
void __iomem *hw_addr_cmd;
u16 cmd_reg_cache;
};
#define to_ks8851_par(ks) container_of((ks), struct ks8851_net_par, ks8851)
static void ks8851_lock_par(struct ks8851_net *ks, unsigned long *flags)
{
struct ks8851_net_par *ksp = to_ks8851_par(ks);
spin_lock_irqsave(&ksp->lock, *flags);
}
static void ks8851_unlock_par(struct ks8851_net *ks, unsigned long *flags)
{
struct ks8851_net_par *ksp = to_ks8851_par(ks);
spin_unlock_irqrestore(&ksp->lock, *flags);
}
static int ks_check_endian(struct ks8851_net *ks)
{
struct ks8851_net_par *ksp = to_ks8851_par(ks);
u16 cider;
iowrite16(BE3 | BE2 | KS_CIDER, ksp->hw_addr_cmd);
cider = ioread16(ksp->hw_addr);
if (!cider)
return 0;
netdev_err(ks->netdev, "incorrect EESK endian strap setting\n");
return -EINVAL;
}
static void ks8851_wrreg16_par(struct ks8851_net *ks, unsigned int reg,
unsigned int val)
{
struct ks8851_net_par *ksp = to_ks8851_par(ks);
ksp->cmd_reg_cache = (u16)reg | ((BE1 | BE0) << (reg & 0x02));
iowrite16(ksp->cmd_reg_cache, ksp->hw_addr_cmd);
iowrite16(val, ksp->hw_addr);
}
static unsigned int ks8851_rdreg16_par(struct ks8851_net *ks, unsigned int reg)
{
struct ks8851_net_par *ksp = to_ks8851_par(ks);
ksp->cmd_reg_cache = (u16)reg | ((BE1 | BE0) << (reg & 0x02));
iowrite16(ksp->cmd_reg_cache, ksp->hw_addr_cmd);
return ioread16(ksp->hw_addr);
}
static void ks8851_rdfifo_par(struct ks8851_net *ks, u8 *buff, unsigned int len)
{
struct ks8851_net_par *ksp = to_ks8851_par(ks);
netif_dbg(ks, rx_status, ks->netdev,
"%s: %d@%p\n", __func__, len, buff);
ioread16_rep(ksp->hw_addr, (u16 *)buff + 1, len / 2);
}
static void ks8851_wrfifo_par(struct ks8851_net *ks, struct sk_buff *txp,
bool irq)
{
struct ks8851_net_par *ksp = to_ks8851_par(ks);
unsigned int len = ALIGN(txp->len, 4);
unsigned int fid = 0;
netif_dbg(ks, tx_queued, ks->netdev, "%s: skb %p, %d@%p, irq %d\n",
__func__, txp, txp->len, txp->data, irq);
fid = ks->fid++;
fid &= TXFR_TXFID_MASK;
if (irq)
fid |= TXFR_TXIC;
iowrite16(fid, ksp->hw_addr);
iowrite16(txp->len, ksp->hw_addr);
iowrite16_rep(ksp->hw_addr, txp->data, len / 2);
}
static void ks8851_rx_skb_par(struct ks8851_net *ks, struct sk_buff *skb)
{
netif_rx(skb);
}
static unsigned int ks8851_rdreg16_par_txqcr(struct ks8851_net *ks)
{
return ks8851_rdreg16_par(ks, KS_TXQCR);
}
static netdev_tx_t ks8851_start_xmit_par(struct sk_buff *skb,
struct net_device *dev)
{
struct ks8851_net *ks = netdev_priv(dev);
netdev_tx_t ret = NETDEV_TX_OK;
unsigned long flags;
unsigned int txqcr;
u16 txmir;
int err;
netif_dbg(ks, tx_queued, ks->netdev,
"%s: skb %p, %d@%p\n", __func__, skb, skb->len, skb->data);
ks8851_lock_par(ks, &flags);
txmir = ks8851_rdreg16_par(ks, KS_TXMIR) & 0x1fff;
if (likely(txmir >= skb->len + 12)) {
ks8851_wrreg16_par(ks, KS_RXQCR, ks->rc_rxqcr | RXQCR_SDA);
ks8851_wrfifo_par(ks, skb, false);
ks8851_wrreg16_par(ks, KS_RXQCR, ks->rc_rxqcr);
ks8851_wrreg16_par(ks, KS_TXQCR, TXQCR_METFE);
err = readx_poll_timeout_atomic(ks8851_rdreg16_par_txqcr, ks,
txqcr, !(txqcr & TXQCR_METFE),
5, 1000000);
if (err)
ret = NETDEV_TX_BUSY;
ks8851_done_tx(ks, skb);
} else {
ret = NETDEV_TX_BUSY;
}
ks8851_unlock_par(ks, &flags);
return ret;
}
static int ks8851_probe_par(struct platform_device *pdev)
{
struct device *dev = &pdev->dev;
struct ks8851_net_par *ksp;
struct net_device *netdev;
struct ks8851_net *ks;
int ret;
netdev = devm_alloc_etherdev(dev, sizeof(struct ks8851_net_par));
if (!netdev)
return -ENOMEM;
ks = netdev_priv(netdev);
ks->lock = ks8851_lock_par;
ks->unlock = ks8851_unlock_par;
ks->rdreg16 = ks8851_rdreg16_par;
ks->wrreg16 = ks8851_wrreg16_par;
ks->rdfifo = ks8851_rdfifo_par;
ks->wrfifo = ks8851_wrfifo_par;
ks->start_xmit = ks8851_start_xmit_par;
ks->rx_skb = ks8851_rx_skb_par;
#define STD_IRQ (IRQ_LCI | /* Link Change */ \
IRQ_RXI | /* RX done */ \
IRQ_RXPSI) /* RX process stop */
ks->rc_ier = STD_IRQ;
ksp = to_ks8851_par(ks);
spin_lock_init(&ksp->lock);
ksp->hw_addr = devm_platform_ioremap_resource(pdev, 0);
if (IS_ERR(ksp->hw_addr))
return PTR_ERR(ksp->hw_addr);
ksp->hw_addr_cmd = devm_platform_ioremap_resource(pdev, 1);
if (IS_ERR(ksp->hw_addr_cmd))
return PTR_ERR(ksp->hw_addr_cmd);
ret = ks_check_endian(ks);
if (ret)
return ret;
netdev->irq = platform_get_irq(pdev, 0);
if (netdev->irq < 0)
return netdev->irq;
return ks8851_probe_common(netdev, dev, msg_enable);
}
static int ks8851_remove_par(struct platform_device *pdev)
{
ks8851_remove_common(&pdev->dev);
return 0;
}
static const struct of_device_id ks8851_match_table[] = {
{ .compatible = "micrel,ks8851-mll" },
{ }
};
MODULE_DEVICE_TABLE(of, ks8851_match_table);
static struct platform_driver ks8851_driver = {
.driver = {
.name = "ks8851",
.of_match_table = ks8851_match_table,
.pm = &ks8851_pm_ops,
},
.probe = ks8851_probe_par,
.remove = ks8851_remove_par,
};
module_platform_driver(ks8851_driver);
MODULE_DESCRIPTION("KS8851 Network driver");
MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
MODULE_LICENSE("GPL");
module_param_named(message, msg_enable, int, 0);
MODULE_PARM_DESC(message, "Message verbosity level (0=none, 31=all)"