linux-imx

/*

 * PTP 1588 clock for Freescale QorIQ 1588 timer

 *

 * Copyright (C) 2010 OMICRON electronics GmbH

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License as published by

 *  the Free Software Foundation; either version 2 of the License, or

 *  (at your option) any later version.

 *

 *  This program is distributed in the hope that it will be useful,

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 *  GNU General Public License for more details.

 *

 *  You should have received a copy of the GNU General Public License

 *  along with this program; if not, write to the Free Software

 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

 */

​

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

​

#include <linux/device.h>

#include <linux/hrtimer.h>

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/of.h>

#include <linux/of_platform.h>

#include <linux/timex.h>

#include <linux/slab.h>

#include <linux/clk.h>

​

#include <linux/fsl/ptp_qoriq.h>

​

/*

 * Register access functions

 */

​

/* Caller must hold ptp_qoriq->lock. */

static u64 tmr_cnt_read(struct ptp_qoriq *ptp_qoriq)

{

    struct ptp_qoriq_registers *regs = &ptp_qoriq->regs;

    u64 ns;

    u32 lo, hi;

​

    lo = ptp_qoriq->read(&regs->ctrl_regs->tmr_cnt_l);

    hi = ptp_qoriq->read(&regs->ctrl_regs->tmr_cnt_h);

    ns = ((u64) hi) << 32;

    ns |= lo;

    return ns;

}

​

/* Caller must hold ptp_qoriq->lock. */

static void tmr_cnt_write(struct ptp_qoriq *ptp_qoriq, u64 ns)

{

    struct ptp_qoriq_registers *regs = &ptp_qoriq->regs;

    u32 hi = ns >> 32;

    u32 lo = ns & 0xffffffff;

​

    ptp_qoriq->write(&regs->ctrl_regs->tmr_cnt_l, lo);

    ptp_qoriq->write(&regs->ctrl_regs->tmr_cnt_h, hi);

}

​

/* Caller must hold ptp_qoriq->lock. */

static void set_alarm(struct ptp_qoriq *ptp_qoriq)

{

    struct ptp_qoriq_registers *regs = &ptp_qoriq->regs;

    u64 ns;

    u32 lo, hi;

​

    ns = tmr_cnt_read(ptp_qoriq) + 1500000000ULL;

    ns = div_u64(ns, 1000000000UL) * 1000000000ULL;

    ns -= ptp_qoriq->tclk_period;

    hi = ns >> 32;

    lo = ns & 0xffffffff;

    ptp_qoriq->write(&regs->alarm_regs->tmr_alarm1_l, lo);

    ptp_qoriq->write(&regs->alarm_regs->tmr_alarm1_h, hi);

}

​

/* Caller must hold ptp_qoriq->lock. */

static void set_fipers(struct ptp_qoriq *ptp_qoriq)

{

    struct ptp_qoriq_registers *regs = &ptp_qoriq->regs;

​

    set_alarm(ptp_qoriq);

    ptp_qoriq->write(&regs->fiper_regs->tmr_fiper1, ptp_qoriq->tmr_fiper1);

    ptp_qoriq->write(&regs->fiper_regs->tmr_fiper2, ptp_qoriq->tmr_fiper2);

}

​

static int extts_clean_up(struct ptp_qoriq *ptp_qoriq, int index,

              bool update_event)

{