init.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"

static struct sigevent event;

void *
mx21_init(int argc, char *argv[])
{
	mx21_dev_t	*dev;

	if (-1 == ThreadCtl(_NTO_TCTL_IO, 0)) {
		perror("ThreadCtl");
		return NULL;
	}

	dev = malloc(sizeof(mx21_dev_t));
	if (!dev)
		return NULL;

	if (-1 == mx21_options(dev, argc, argv))
		goto fail;
	dev->regbase = mmap_device_io(0x20, dev->physbase);
	if (dev->regbase == (uintptr_t)MAP_FAILED) {
		perror("mmap_device_io");
		goto fail;
	}

   	out16(dev->regbase + MX21_I2C_FDR, 0x39);

	/* Software reset */
   	out16(dev->regbase + MX21_I2C_CR,  0x00);
   	out16(dev->regbase + MX21_I2C_CR,  MX21_I2CR_EN);

	/* Clear status */
   	out16(dev->regbase + MX21_I2C_SR,  0x00);

	if (in16(dev->regbase + MX21_I2C_SR) & MX21_I2SR_IBB) {
		/* Bus busy , generate a stop condition */
		perror("Bus busy");
	}

	if (dev->options & MX21_OPT_POLLING)
		return dev;

	SIGEV_INTR_INIT(&event);
	dev->iid = InterruptAttachEvent(dev->irq, &event, 0);
	if (dev->iid != -1)
    	return dev;

fail:
	munmap_device_io(dev->regbase, 0x20);
    free(dev);

    return NULL;
}