rockbox/firmware/target/arm/imx233/sansa-fuzeplus/fmradio-i2c-fuzeplus.c

/***************************************************************************
 *             __________               __   ___.
 *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
 *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
 *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
 *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
 *                     \/            \/     \/    \/            \/
 * $Id$
 *
 * Copyright (C) 2011 by Amaury Pouly
 *
 * 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
 * KIND, either express or implied.
 *
 ****************************************************************************/

#include "config.h"
#include "system.h"
#include "fmradio_i2c.h"
#include "pinctrl-imx233.h"
#include "generic_i2c.h"
#include "rds.h"
#include "si4700.h"

/**
 * Sansa Fuze+ fmradio uses the following pins:
 * - B0P29 as CE apparently (active high)
 * - B1P24 as SDA
 * - B1P22 as SCL
 * - B2P27 as STC/RDS
 */
static int fmradio_i2c_bus = -1;

static void i2c_scl_dir(bool out)
{
    imx233_pinctrl_enable_gpio(1, 22, out);
}

static void i2c_sda_dir(bool out)
{
    imx233_pinctrl_enable_gpio(1, 24, out);
}

static void i2c_scl_out(bool high)
{
    imx233_pinctrl_set_gpio(1, 22, high);
}

static void i2c_sda_out(bool high)
{
    imx233_pinctrl_set_gpio(1, 24, high);
}

static bool i2c_scl_in(void)
{
    return imx233_pinctrl_get_gpio_mask(1, 1 << 22);
}

static bool i2c_sda_in(void)
{
    return imx233_pinctrl_get_gpio_mask(1, 1 << 24);
}

static void i2c_delay(int d)
{
    udelay(d);
}

struct i2c_interface fmradio_i2c =
{
    .scl_dir = i2c_scl_dir,
    .sda_dir = i2c_sda_dir,
    .scl_out = i2c_scl_out,
    .sda_out = i2c_sda_out,
    .scl_in = i2c_scl_in,
    .sda_in = i2c_sda_in,
    .delay = i2c_delay,
    .delay_hd_sta = 4,
    .delay_hd_dat = 5,
    .delay_su_dat = 1,
    .delay_su_sto = 4,
    .delay_su_sta = 5,
    .delay_thigh = 4
};

void fmradio_i2c_init(void)
{
    imx233_pinctrl_acquire(1, 24, "fmradio i2c");
    imx233_pinctrl_acquire(1, 22, "fmradio i2c");
    imx233_pinctrl_set_function(1, 24, PINCTRL_FUNCTION_GPIO);
    imx233_pinctrl_set_function(1, 22, PINCTRL_FUNCTION_GPIO);
    fmradio_i2c_bus = i2c_add_node(&fmradio_i2c);
}

int fmradio_i2c_write(unsigned char address, const unsigned char* buf, int count)
{
    return i2c_write_data(fmradio_i2c_bus, address, -1, buf, count);
}

int fmradio_i2c_read(unsigned char address, unsigned char* buf, int count)
{
    return i2c_read_data(fmradio_i2c_bus, address, -1, buf, count);
}

#ifdef HAVE_RDS_CAP
/* Low-level RDS Support */
static struct semaphore rds_sema;
static uint32_t rds_stack[DEFAULT_STACK_SIZE / sizeof(uint32_t)];

/* RDS GPIO interrupt handler */
static void stc_rds_callback(int bank, int pin)
{
    (void) bank;
    (void) pin;

    semaphore_release(&rds_sema);
}

/* Captures RDS data and processes it */
static void NORETURN_ATTR rds_thread(void)
{
    uint16_t rds_data[4];

    while(true)
    {
        semaphore_wait(&rds_sema, TIMEOUT_BLOCK);
        if(si4700_rds_read_raw(rds_data) && rds_process(rds_data))
            si4700_rds_set_event();
        /* renable callback */
        imx233_pinctrl_setup_irq(2, 27, true, true, false, &stc_rds_callback);
    }
}

/* true after full radio power up, and false before powering down */
void si4700_rds_powerup(bool on)
{
    if(on)
    {
        imx233_pinctrl_acquire(2, 27, "tuner stc/rds");
        imx233_pinctrl_set_function(2, 27, PINCTRL_FUNCTION_GPIO);
        imx233_pinctrl_enable_gpio(2, 27, false);
        /* pin is set to 0 when an RDS packet has arrived */
        imx233_pinctrl_setup_irq(2, 27, true, true, false, &stc_rds_callback);
    }
    else
    {
        imx233_pinctrl_setup_irq(2, 27, false, false, false, NULL);
        imx233_pinctrl_release(2, 27, "tuner stc/rds");
    }
}

/* One-time RDS init at startup */
void si4700_rds_init(void)
{
    semaphore_init(&rds_sema, 1, 0);
    rds_init();
    create_thread(rds_thread, rds_stack, sizeof(rds_stack), 0, "rds"
        IF_PRIO(, PRIORITY_REALTIME) IF_COP(, CPU));
}
#endif /* HAVE_RDS_CAP */