/*
   * OMAP SoC specific OPP wrapper function
   *
   * Copyright (C) 2009-2010 Texas Instruments Incorporated - http://www.ti.com/
   *	Nishanth Menon
   *	Kevin Hilman
   * Copyright (C) 2010 Nokia Corporation.
   *      Eduardo Valentin
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   *
   * This program is distributed "as is" WITHOUT ANY WARRANTY of any
   * kind, whether express or implied; without even the implied warranty
   * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   */
  #include <linux/module.h>
  #include <linux/of.h>
  #include <linux/pm_opp.h>
  #include <linux/cpu.h>
  
  #include "omap_device.h"
  
  #include "omap_opp_data.h"
  
  /* Temp variable to allow multiple calls */
  static u8 __initdata omap_table_init;
  
  /**
   * omap_init_opp_table() - Initialize opp table as per the CPU type
   * @opp_def:		opp default list for this silicon
   * @opp_def_size:	number of opp entries for this silicon
   *
   * Register the initial OPP table with the OPP library based on the CPU
   * type. This is meant to be used only by SoC specific registration.
   */
  int __init omap_init_opp_table(struct omap_opp_def *opp_def,
  		u32 opp_def_size)
  {
  	int i, r;
  
  	if (of_have_populated_dt())
  		return -EINVAL;
  
  	if (!opp_def || !opp_def_size) {
  		pr_err("%s: invalid params!
  ", __func__);
  		return -EINVAL;
  	}
  
  	/*
  	 * Initialize only if not already initialized even if the previous
  	 * call failed, because, no reason we'd succeed again.
  	 */
  	if (omap_table_init)
  		return -EEXIST;
  	omap_table_init = 1;
  
  	/* Lets now register with OPP library */
  	for (i = 0; i < opp_def_size; i++, opp_def++) {
  		struct omap_hwmod *oh;
  		struct device *dev;
  
  		if (!opp_def->hwmod_name) {
  			pr_err("%s: NULL name of omap_hwmod, failing [%d].
  ",
  				__func__, i);
  			return -EINVAL;
  		}
  
  		if (!strncmp(opp_def->hwmod_name, "mpu", 3)) {
  			/* 
  			 * All current OMAPs share voltage rail and
  			 * clock source, so CPU0 is used to represent
  			 * the MPU-SS.
  			 */
  			dev = get_cpu_device(0);
  		} else {
  			oh = omap_hwmod_lookup(opp_def->hwmod_name);
  			if (!oh || !oh->od) {
  				pr_debug("%s: no hwmod or odev for %s, [%d] cannot add OPPs.
  ",
  					 __func__, opp_def->hwmod_name, i);
  				continue;
  			}
  			dev = &oh->od->pdev->dev;
  		}
  
  		r = dev_pm_opp_add(dev, opp_def->freq, opp_def->u_volt);
  		if (r) {
  			dev_err(dev, "%s: add OPP %ld failed for %s [%d] result=%d
  ",
  				__func__, opp_def->freq,
  				opp_def->hwmod_name, i, r);
  		} else {
  			if (!opp_def->default_available)
  				r = dev_pm_opp_disable(dev, opp_def->freq);
  			if (r)
  				dev_err(dev, "%s: disable %ld failed for %s [%d] result=%d
  ",
  					__func__, opp_def->freq,
  					opp_def->hwmod_name, i, r);
  		}
  	}
  
  	return 0;
  }