bus_speed.c

QNX ADS BSP code for i.MX27 chips

/*
 * $QNXLicenseC: 
 * Copyright 2007, QNX Software Systems.  
 *  
 * Licensed under the Apache License, Version 2.0 (the "License"). You  
 * may not reproduce, modify or distribute this software except in  
 * compliance with the License. You may obtain a copy of the License  
 * at: http://www.apache.org/licenses/LICENSE-2.0  
 *  
 * Unless required by applicable law or agreed to in writing, software  
 * distributed under the License is distributed on an "AS IS" basis,  
 * WITHOUT WARRANTIES OF ANY KIND, either express or implied. 
 * 
 * This file may contain contributions from others, either as  
 * contributors under the License or as licensors under other terms.   
 * Please review this entire file for other proprietary rights or license  
 * notices, as well as the QNX Development Suite License Guide at  
 * http://licensing.qnx.com/license-guide/ for other information. 
 * $
 */


#include "proto.h"

int
mx21_set_bus_speed(void *hdl, unsigned int speed, unsigned int *ospeed)
{
	mx21_dev_t	*dev = hdl;
	uint16_t	ifdr = 0x39;

	if (speed > 400000) {
		errno = EINVAL;
		return -1;
	}

	/*
	 * Assume the PERCLK is 266MHz
	 */
	switch (speed) {
		case 200:
			ifdr = 0x3D;
			break;
	}

   	out16(dev->regbase + MX21_I2C_FDR, ifdr);

	if (ospeed)
		*ospeed = ifdr;

	return 0;
}