119 lines
3.1 KiB
C
119 lines
3.1 KiB
C
|
/*
|
||
|
|
* Copyright 2015 NXP Semiconductors
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify
|
||
|
|
* it under the terms of the GNU General Public License version 2 or later
|
||
|
|
* as published by the Free Software Foundation.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <stdlib.h>
|
||
|
|
#include <string.h>
|
||
|
|
#include "tfa_dsp_fw.h"
|
||
|
|
#include "dbgprint.h"
|
||
|
|
#include "NXP_I2C.h"
|
||
|
|
#include "tfa_internal.h"
|
||
|
|
#include "lxScribo.h"
|
||
|
|
|
||
|
|
/* translate a I2C driver error into an error */
|
||
|
|
static enum tfa98xx_error
|
||
|
|
tfa98xx_classify_i2c_error(enum NXP_I2C_Error i2c_error)
|
||
|
|
{
|
||
|
|
switch (i2c_error) {
|
||
|
|
case NXP_I2C_Ok:
|
||
|
|
return TFA98XX_ERROR_OK;
|
||
|
|
case NXP_I2C_NoAck:
|
||
|
|
case NXP_I2C_ArbLost:
|
||
|
|
case NXP_I2C_TimeOut:
|
||
|
|
return TFA98XX_ERROR_I2C_NON_FATAL;
|
||
|
|
default:
|
||
|
|
return TFA98XX_ERROR_I2C_FATAL;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
/*
|
||
|
|
* write a 16 bit subaddress
|
||
|
|
*/
|
||
|
|
enum tfa98xx_error
|
||
|
|
tfa98xx_write_register16(tfa98xx_handle_t handle,
|
||
|
|
unsigned char subaddress, unsigned short value)
|
||
|
|
{
|
||
|
|
enum NXP_I2C_Error i2c_error;
|
||
|
|
unsigned char write_data[3]; /* subaddress and 2 bytes of the value */
|
||
|
|
|
||
|
|
if (!tfa98xx_handle_is_open(handle))
|
||
|
|
return TFA98XX_ERROR_NOT_OPEN;
|
||
|
|
|
||
|
|
write_data[0] = subaddress;
|
||
|
|
write_data[1] = (value >> 8) & 0xFF;
|
||
|
|
write_data[2] = value & 0xFF;
|
||
|
|
|
||
|
|
i2c_error = NXP_I2C_WriteRead
|
||
|
|
(handles_local[handle].slave_address, sizeof(write_data),
|
||
|
|
write_data, 0, NULL);
|
||
|
|
|
||
|
|
return tfa98xx_classify_i2c_error(i2c_error);
|
||
|
|
}
|
||
|
|
|
||
|
|
enum tfa98xx_error
|
||
|
|
tfa98xx_read_register16(tfa98xx_handle_t handle,
|
||
|
|
unsigned char subaddress, unsigned short *p_value)
|
||
|
|
{
|
||
|
|
enum NXP_I2C_Error i2c_error;
|
||
|
|
unsigned char write_data[1]; /* subaddress */
|
||
|
|
unsigned char read_buffer[2]; /* 2 data bytes */
|
||
|
|
|
||
|
|
_ASSERT(p_value != NULL);
|
||
|
|
if (!tfa98xx_handle_is_open(handle))
|
||
|
|
return TFA98XX_ERROR_NOT_OPEN;
|
||
|
|
write_data[0] = subaddress;
|
||
|
|
read_buffer[0] = read_buffer[1] = 0;
|
||
|
|
|
||
|
|
i2c_error = NXP_I2C_WriteRead
|
||
|
|
(handles_local[handle].slave_address, sizeof(write_data),
|
||
|
|
write_data, sizeof(read_buffer), read_buffer);
|
||
|
|
|
||
|
|
if (tfa98xx_classify_i2c_error(i2c_error) != TFA98XX_ERROR_OK)
|
||
|
|
return tfa98xx_classify_i2c_error(i2c_error);
|
||
|
|
|
||
|
|
*p_value = (read_buffer[0] << 8) + read_buffer[1];
|
||
|
|
return TFA98XX_ERROR_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
enum tfa98xx_error
|
||
|
|
tfa98xx_read_data(tfa98xx_handle_t handle,
|
||
|
|
unsigned char subaddress, int num_bytes, unsigned char data[])
|
||
|
|
{
|
||
|
|
enum NXP_I2C_Error i2c_error;
|
||
|
|
unsigned char write_data[1]; /* subaddress */
|
||
|
|
|
||
|
|
if (!tfa98xx_handle_is_open(handle))
|
||
|
|
return TFA98XX_ERROR_NOT_OPEN;
|
||
|
|
if (num_bytes > handles_local[handle].buffer_size)
|
||
|
|
return TFA98XX_ERROR_BAD_PARAMETER;
|
||
|
|
|
||
|
|
write_data[0] = subaddress;
|
||
|
|
i2c_error = NXP_I2C_WriteRead
|
||
|
|
(handles_local[handle].slave_address, sizeof(write_data),
|
||
|
|
write_data, num_bytes, data);
|
||
|
|
return tfa98xx_classify_i2c_error(i2c_error);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Write raw I2C data with no sub address
|
||
|
|
*/
|
||
|
|
enum tfa98xx_error
|
||
|
|
tfa98xx_write_raw(tfa98xx_handle_t handle,
|
||
|
|
int num_bytes,
|
||
|
|
const unsigned char data[])
|
||
|
|
{
|
||
|
|
enum NXP_I2C_Error i2c_error;
|
||
|
|
|
||
|
|
if (!tfa98xx_handle_is_open(handle))
|
||
|
|
return TFA98XX_ERROR_NOT_OPEN;
|
||
|
|
if (num_bytes > handles_local[handle].buffer_size)
|
||
|
|
return TFA98XX_ERROR_BAD_PARAMETER;
|
||
|
|
i2c_error = NXP_I2C_WriteRead
|
||
|
|
(handles_local[handle].slave_address, num_bytes,
|
||
|
|
data, 0, NULL);
|
||
|
|
return tfa98xx_classify_i2c_error(i2c_error);
|
||
|
|
}
|