mirror of https://github.com/ARMmbed/mbed-os.git
				
				
				
			
		
			
				
	
	
		
			349 lines
		
	
	
		
			9.3 KiB
		
	
	
	
		
			C
		
	
	
			
		
		
	
	
			349 lines
		
	
	
		
			9.3 KiB
		
	
	
	
		
			C
		
	
	
/* mbed Microcontroller Library
 | 
						|
 * (C)Copyright TOSHIBA ELECTRONIC DEVICES & STORAGE CORPORATION 2017 All rights reserved
 | 
						|
 *
 | 
						|
 * Licensed under the Apache License, Version 2.0 (the "License");
 | 
						|
 * you may not use this file 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 OR CONDITIONS OF ANY KIND, either express or implied.
 | 
						|
 * See the License for the specific language governing permissions and
 | 
						|
 * limitations under the License.
 | 
						|
 */
 | 
						|
#include "i2c_api.h"
 | 
						|
#include "mbed_error.h"
 | 
						|
#include "PeripheralNames.h"
 | 
						|
#include "pinmap.h"
 | 
						|
#include "tmpm46b_i2c.h"
 | 
						|
#include <string.h>
 | 
						|
#include <stdlib.h>
 | 
						|
 | 
						|
static const PinMap PinMap_I2C_SDA[] = {
 | 
						|
    {PK2, I2C_0, PIN_DATA(3, 2)},
 | 
						|
    {PF7, I2C_1, PIN_DATA(4, 2)},
 | 
						|
    {PH0, I2C_2, PIN_DATA(4, 2)},
 | 
						|
    {NC,  NC,    0}
 | 
						|
};
 | 
						|
 | 
						|
static const PinMap PinMap_I2C_SCL[] = {
 | 
						|
    {PK3, I2C_0, PIN_DATA(3, 2)},
 | 
						|
    {PF6, I2C_1, PIN_DATA(4, 2)},
 | 
						|
    {PH1, I2C_2, PIN_DATA(4, 2)},
 | 
						|
    {NC,  NC,    0}
 | 
						|
};
 | 
						|
 | 
						|
#define SBI_I2C_SEND              0x00
 | 
						|
#define SBI_I2C_RECEIVE           0x01
 | 
						|
#define MAX_NUM_I2C               3
 | 
						|
#define DELAY_MS_MULTIPLIER       5500
 | 
						|
 | 
						|
struct i2c_xfer {
 | 
						|
    int32_t count;
 | 
						|
    int32_t len;
 | 
						|
    void *done;
 | 
						|
    char *buf;
 | 
						|
};
 | 
						|
 | 
						|
// Clock setting structure definition
 | 
						|
typedef struct {
 | 
						|
    uint32_t sck;
 | 
						|
    uint32_t prsck;
 | 
						|
} I2C_clock_setting_t;
 | 
						|
 | 
						|
static void DelayMS(uint32_t delay)
 | 
						|
{
 | 
						|
    volatile uint32_t VarI;
 | 
						|
    for (VarI = 0; VarI < delay * DELAY_MS_MULTIPLIER; VarI++);
 | 
						|
}
 | 
						|
 | 
						|
static const uint32_t I2C_SCK_DIVIDER_TBL[8] = {
 | 
						|
    20, 24, 32, 48, 80, 144, 272, 528
 | 
						|
};  // SCK Divider value table
 | 
						|
 | 
						|
static I2C_clock_setting_t clk;
 | 
						|
static I2C_InitTypeDef myi2c;
 | 
						|
static int32_t start_flag = 1;
 | 
						|
static struct i2c_xfer xfer[MAX_NUM_I2C];
 | 
						|
static TSB_I2C_TypeDef *i2c_lut[MAX_NUM_I2C] = {TSB_I2C0, TSB_I2C1, TSB_I2C2};
 | 
						|
static char *gI2C_TxData = NULL;
 | 
						|
static char *gI2C_LTxData = NULL;
 | 
						|
static uint8_t send_byte = 0;
 | 
						|
static uint8_t byte_func = 0;
 | 
						|
 | 
						|
// Initialize the I2C peripheral. It sets the default parameters for I2C
 | 
						|
void i2c_init(i2c_t *obj, PinName sda, PinName scl)
 | 
						|
{
 | 
						|
    MBED_ASSERT(obj != NULL);
 | 
						|
    I2CName i2c_sda = (I2CName)pinmap_peripheral(sda, PinMap_I2C_SDA);
 | 
						|
    I2CName i2c_scl = (I2CName)pinmap_peripheral(scl, PinMap_I2C_SCL);
 | 
						|
    I2CName i2c_name = (I2CName)pinmap_merge(i2c_sda, i2c_scl);
 | 
						|
    MBED_ASSERT((int)i2c_name != NC);
 | 
						|
 | 
						|
    switch(i2c_name) {
 | 
						|
        case I2C_0:
 | 
						|
            CG_SetFcPeriphB(CG_FC_PERIPH_I2C0, ENABLE);
 | 
						|
            CG_SetFcPeriphA(CG_FC_PERIPH_PORTK, ENABLE);
 | 
						|
            obj->i2c = TSB_I2C0;
 | 
						|
            obj->index = 0;
 | 
						|
            obj->IRQn = INTI2C0_IRQn;
 | 
						|
            break;
 | 
						|
        case I2C_1:
 | 
						|
            CG_SetFcPeriphB(CG_FC_PERIPH_I2C1, ENABLE);
 | 
						|
            CG_SetFcPeriphA(CG_FC_PERIPH_PORTF, ENABLE);
 | 
						|
            obj->i2c = TSB_I2C1;
 | 
						|
            obj->index = 1;
 | 
						|
            obj->IRQn = INTI2C1_IRQn;
 | 
						|
            break;
 | 
						|
        case I2C_2:
 | 
						|
            CG_SetFcPeriphB(CG_FC_PERIPH_I2C2, ENABLE);
 | 
						|
            CG_SetFcPeriphA(CG_FC_PERIPH_PORTH, ENABLE);
 | 
						|
            obj->i2c = TSB_I2C2;
 | 
						|
            obj->index = 2;
 | 
						|
            obj->IRQn = INTI2C2_IRQn;
 | 
						|
            break;
 | 
						|
        default:
 | 
						|
            error("I2C is not available");
 | 
						|
            break;
 | 
						|
    }
 | 
						|
 | 
						|
    pinmap_pinout(sda, PinMap_I2C_SDA);
 | 
						|
    pin_mode(sda, OpenDrain);
 | 
						|
    pin_mode(sda, PullUp);
 | 
						|
 | 
						|
    pinmap_pinout(scl, PinMap_I2C_SCL);
 | 
						|
    pin_mode(scl, OpenDrain);
 | 
						|
    pin_mode(scl, PullUp);
 | 
						|
 | 
						|
    i2c_reset(obj);
 | 
						|
    i2c_frequency(obj, 100000);
 | 
						|
}
 | 
						|
 | 
						|
// Configure the I2C frequency
 | 
						|
void i2c_frequency(i2c_t *obj, int hz)
 | 
						|
{
 | 
						|
    uint32_t sck = 0;
 | 
						|
    uint32_t tmp_sck = 0;
 | 
						|
    uint32_t prsck = 1;
 | 
						|
    uint32_t tmp_prsck = 1;
 | 
						|
    uint32_t fscl = 0;
 | 
						|
    uint32_t tmp_fscl = 0;
 | 
						|
    uint64_t fx;
 | 
						|
 | 
						|
    if (hz <= 400000) { // Maximum 400khz clock frequency supported by  M46B
 | 
						|
        for (prsck = 1; prsck <= 32; prsck++) {
 | 
						|
            fx = ((uint64_t)SystemCoreClock / prsck);
 | 
						|
            if ((fx < 20000000U) && (fx > 6666666U)) {
 | 
						|
                for (sck = 0; sck <= 7; sck++) {
 | 
						|
                    fscl = (fx / (uint64_t)I2C_SCK_DIVIDER_TBL[sck]);
 | 
						|
                    if ((fscl <= (uint64_t)hz) && (fscl > tmp_fscl)) {
 | 
						|
                        tmp_fscl = fscl;
 | 
						|
                        tmp_sck = sck;
 | 
						|
                        tmp_prsck = (prsck < 32)? prsck: 1;
 | 
						|
                    }
 | 
						|
                }
 | 
						|
            }
 | 
						|
        }
 | 
						|
        clk.sck = (uint32_t)tmp_sck;
 | 
						|
        clk.prsck = (tmp_prsck < 32)? (uint32_t)tmp_prsck - 1 : 1;
 | 
						|
    } else {
 | 
						|
        clk.sck = I2C_SCK_CLK_DIV_24;
 | 
						|
        clk.prsck = I2C_PRESCALER_DIV_4;
 | 
						|
    }
 | 
						|
    myi2c.I2CSelfAddr = 0xE0; // Self Address
 | 
						|
    myi2c.I2CDataLen = I2C_DATA_LEN_8;
 | 
						|
    myi2c.I2CACKState = ENABLE;
 | 
						|
    myi2c.I2CClkDiv = clk.sck;
 | 
						|
    myi2c.PrescalerClkDiv = clk.prsck;
 | 
						|
 | 
						|
    I2C_SWReset(obj->i2c);
 | 
						|
    I2C_Init(obj->i2c, &myi2c);
 | 
						|
    NVIC_EnableIRQ(obj->IRQn);
 | 
						|
    I2C_SetINTReq(obj->i2c, ENABLE);
 | 
						|
}
 | 
						|
 | 
						|
int i2c_start(i2c_t *obj)
 | 
						|
{
 | 
						|
    start_flag = 1;
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
int i2c_stop(i2c_t *obj)
 | 
						|
{
 | 
						|
    I2C_GenerateStop(obj->i2c);
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
void i2c_reset(i2c_t *obj)
 | 
						|
{
 | 
						|
    I2C_SWReset(obj->i2c);
 | 
						|
}
 | 
						|
 | 
						|
static void wait_i2c_bus_free(i2c_t *obj)
 | 
						|
{
 | 
						|
    I2C_State status;
 | 
						|
 | 
						|
    do {
 | 
						|
        status = I2C_GetState(obj->i2c);
 | 
						|
    } while (status.Bit.BusState);
 | 
						|
}
 | 
						|
 | 
						|
int i2c_read(i2c_t *obj, int address, char *data, int length, int stop)
 | 
						|
{
 | 
						|
    TSB_I2C_TypeDef *sbi = obj->i2c;
 | 
						|
    uint32_t i2c_num = 0;
 | 
						|
    obj->address = address;
 | 
						|
 | 
						|
    i2c_num = obj->index;
 | 
						|
 | 
						|
    // receive data
 | 
						|
    xfer[i2c_num].count = 0;
 | 
						|
    xfer[i2c_num].len = length;
 | 
						|
    xfer[i2c_num].buf = data;
 | 
						|
 | 
						|
    I2C_SetSendData(sbi, address | SBI_I2C_RECEIVE);
 | 
						|
    I2C_GenerateStart(sbi);
 | 
						|
 | 
						|
    wait_i2c_bus_free(obj);
 | 
						|
    return (xfer[i2c_num].count - 1);
 | 
						|
}
 | 
						|
 | 
						|
int i2c_write(i2c_t *obj, int address, const char *data, int length, int stop)
 | 
						|
{
 | 
						|
    int8_t i = 0;
 | 
						|
    TSB_I2C_TypeDef *sbi = obj->i2c;
 | 
						|
    uint32_t i2c_num = 0;
 | 
						|
    obj->address = address;
 | 
						|
 | 
						|
    i2c_num = obj->index;
 | 
						|
    gI2C_TxData = (char *)calloc(length, sizeof(int8_t));
 | 
						|
 | 
						|
    for (i = 0; i < length; i++) {
 | 
						|
        gI2C_TxData[i] = data[i];
 | 
						|
    }
 | 
						|
    // receive data
 | 
						|
    xfer[i2c_num].count = 0;
 | 
						|
    xfer[i2c_num].len = length;
 | 
						|
    xfer[i2c_num].buf = gI2C_TxData;
 | 
						|
 | 
						|
    I2C_SetSendData(sbi, address | SBI_I2C_SEND);
 | 
						|
    I2C_GenerateStart(sbi);  // Start condition
 | 
						|
 | 
						|
    wait_i2c_bus_free(obj);
 | 
						|
    free(gI2C_TxData);
 | 
						|
    DelayMS(8);
 | 
						|
    if (((xfer[i2c_num].count - 1) == 0) && (byte_func == 1)) {
 | 
						|
        send_byte = 1;
 | 
						|
        i2c_byte_write(obj, 0x00);
 | 
						|
        xfer[i2c_num].count = 1;
 | 
						|
        byte_func = 0;
 | 
						|
    }
 | 
						|
    return (xfer[i2c_num].count - 1);
 | 
						|
}
 | 
						|
 | 
						|
int i2c_byte_read(i2c_t *obj, int last)
 | 
						|
{
 | 
						|
    char i2c_ret = 0;
 | 
						|
    i2c_read(obj, obj->address, &i2c_ret, 1, last);
 | 
						|
    return i2c_ret;
 | 
						|
}
 | 
						|
 | 
						|
int i2c_byte_write(i2c_t *obj, int data)
 | 
						|
{
 | 
						|
    uint32_t wb = 1;
 | 
						|
    static size_t counter = 1;
 | 
						|
 | 
						|
    byte_func = 1;
 | 
						|
    if (start_flag == 0 && send_byte == 0) {
 | 
						|
        gI2C_LTxData = (char *)realloc(gI2C_LTxData, counter++);
 | 
						|
        gI2C_LTxData[counter - 2] = data;
 | 
						|
    }
 | 
						|
 | 
						|
    if (send_byte == 1) {
 | 
						|
        wb = i2c_write(obj, obj->address, gI2C_LTxData, (counter - 1), 0);
 | 
						|
        start_flag = 1;
 | 
						|
        send_byte = 0;
 | 
						|
        byte_func = 0;
 | 
						|
        counter = 1;
 | 
						|
        return wb;
 | 
						|
    } else {
 | 
						|
        if (start_flag == 1) {
 | 
						|
            obj->address = data;
 | 
						|
            start_flag = 0;
 | 
						|
        } else {
 | 
						|
            // Store the number of written bytes
 | 
						|
            wb = i2c_write(obj, obj->address, (char*)&data, 1, 0);
 | 
						|
        }
 | 
						|
        if (wb == 1)
 | 
						|
            return 1;
 | 
						|
        else
 | 
						|
            return 0;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void i2c_irq_handler(int i2c_num)
 | 
						|
{
 | 
						|
    uint32_t tmp = 0U;
 | 
						|
    TSB_I2C_TypeDef *sbi = i2c_lut[i2c_num];
 | 
						|
    I2C_State sbi_sr;
 | 
						|
 | 
						|
    sbi_sr = I2C_GetState(sbi);
 | 
						|
 | 
						|
    // we don't support slave mode
 | 
						|
    if (!sbi_sr.Bit.MasterSlave)
 | 
						|
        return;
 | 
						|
 | 
						|
    if (sbi_sr.Bit.TRx) { // Tx mode
 | 
						|
        if (sbi_sr.Bit.LastRxBit) { // LRB=1: the receiver requires no further data.
 | 
						|
            I2C_GenerateStop(sbi);
 | 
						|
        } else { // LRB=0: the receiver requires further data.
 | 
						|
            if (xfer[i2c_num].count < xfer[i2c_num].len) {
 | 
						|
                I2C_SetSendData(sbi, xfer[i2c_num].buf[xfer[i2c_num].count]); // Send next data
 | 
						|
            } else if (xfer[i2c_num].count == xfer[i2c_num].len) { // I2C data send finished.
 | 
						|
                I2C_GenerateStop(sbi);
 | 
						|
            } else {
 | 
						|
                // Do nothing
 | 
						|
            }
 | 
						|
            xfer[i2c_num].count++;
 | 
						|
        }
 | 
						|
    } else { // Rx Mode
 | 
						|
        if (xfer[i2c_num].count > xfer[i2c_num].len) {
 | 
						|
            I2C_GenerateStop(sbi);
 | 
						|
            I2C_SetACK(sbi, ENABLE);
 | 
						|
        } else {
 | 
						|
            if (xfer[i2c_num].count == xfer[i2c_num].len) { // Rx last data
 | 
						|
                I2C_SetBitNum(sbi, I2C_DATA_LEN_1);
 | 
						|
            } else if (xfer[i2c_num].count == (xfer[i2c_num].len - 1)) { // Rx the data second to last
 | 
						|
                // Not generate ACK for next data Rx end.
 | 
						|
                I2C_SetACK(sbi, DISABLE);
 | 
						|
            } else {
 | 
						|
                // Do nothing
 | 
						|
            }
 | 
						|
            tmp = I2C_GetReceiveData(sbi);
 | 
						|
            if (xfer[i2c_num].count > 0) {
 | 
						|
                xfer[i2c_num].buf[xfer[i2c_num].count - 1U] = tmp;
 | 
						|
            } else {
 | 
						|
                // first read is dummy read
 | 
						|
            }
 | 
						|
            xfer[i2c_num].count++;
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void INTI2C0_IRQHandler(void)
 | 
						|
{
 | 
						|
    i2c_irq_handler(0);
 | 
						|
}
 | 
						|
 | 
						|
void INTI2C1_IRQHandler(void)
 | 
						|
{
 | 
						|
    i2c_irq_handler(1);
 | 
						|
}
 | 
						|
 | 
						|
void INTI2C2_IRQHandler(void)
 | 
						|
{
 | 
						|
    i2c_irq_handler(2);
 | 
						|
}
 |