fix i2c routines
This commit is contained in:
parent
99585ca132
commit
495524b96b
|
@ -18,7 +18,7 @@
|
||||||
#define I2C_TIMEOUT 0xefff
|
#define I2C_TIMEOUT 0xefff
|
||||||
#define I2C_TIMEOUT_ACK_POLL 0x180
|
#define I2C_TIMEOUT_ACK_POLL 0x180
|
||||||
|
|
||||||
static uint16_t timeout;
|
static uint32_t timeout;
|
||||||
|
|
||||||
|
|
||||||
void i2c_init()
|
void i2c_init()
|
||||||
|
@ -29,8 +29,7 @@ void i2c_init()
|
||||||
|
|
||||||
i2c.I2C_ClockSpeed = 666666;
|
i2c.I2C_ClockSpeed = 666666;
|
||||||
i2c.I2C_Mode = I2C_Mode_I2C;
|
i2c.I2C_Mode = I2C_Mode_I2C;
|
||||||
i2c.I2C_DutyCycle = I2C_DutyCycle_16_9;
|
i2c.I2C_DutyCycle = I2C_DutyCycle_2; // 16_9;
|
||||||
i2c.I2C_OwnAddress1 = 0x7f;
|
|
||||||
i2c.I2C_Ack = I2C_Ack_Enable;
|
i2c.I2C_Ack = I2C_Ack_Enable;
|
||||||
i2c.I2C_AcknowledgedAddress = I2C_AcknowledgedAddress_7bit;
|
i2c.I2C_AcknowledgedAddress = I2C_AcknowledgedAddress_7bit;
|
||||||
I2C_Init(I2C1, &i2c);
|
I2C_Init(I2C1, &i2c);
|
||||||
|
@ -57,11 +56,13 @@ int8_t i2c_read_addr1b(uint8_t addr, uint8_t reg, uint8_t *data, uint8_t len)
|
||||||
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_TRANSMITTER_MODE_SELECTED) && timeout--);
|
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_TRANSMITTER_MODE_SELECTED) && timeout--);
|
||||||
if (!timeout) return -3;
|
if (!timeout) return -3;
|
||||||
|
|
||||||
|
I2C_AcknowledgeConfig(I2C1, DISABLE);
|
||||||
I2C_SendData(I2C1, reg);
|
I2C_SendData(I2C1, reg);
|
||||||
timeout = I2C_TIMEOUT;
|
timeout = I2C_TIMEOUT;
|
||||||
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_BYTE_TRANSMITTED) && timeout--);
|
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_BYTE_TRANSMITTED) && timeout--);
|
||||||
if (!timeout) return -4;
|
if (!timeout) return -4;
|
||||||
|
|
||||||
|
I2C_AcknowledgeConfig(I2C1, ENABLE);
|
||||||
I2C_GenerateSTART(I2C1, ENABLE);
|
I2C_GenerateSTART(I2C1, ENABLE);
|
||||||
timeout = I2C_TIMEOUT;
|
timeout = I2C_TIMEOUT;
|
||||||
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT) && timeout--);
|
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT) && timeout--);
|
||||||
|
@ -79,12 +80,10 @@ int8_t i2c_read_addr1b(uint8_t addr, uint8_t reg, uint8_t *data, uint8_t len)
|
||||||
|
|
||||||
*data++ = I2C_ReceiveData(I2C1);
|
*data++ = I2C_ReceiveData(I2C1);
|
||||||
len--;
|
len--;
|
||||||
|
|
||||||
if (!len) {
|
|
||||||
I2C_GenerateSTOP(I2C1, ENABLE);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
I2C_GenerateSTOP(I2C1, ENABLE);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -102,6 +101,8 @@ int8_t i2c_write_addr1b(uint8_t addr, uint8_t reg, const uint8_t *data, uint8_t
|
||||||
while((I2C_GetFlagStatus(I2C1, I2C_FLAG_BUSY) != RESET) && timeout--);
|
while((I2C_GetFlagStatus(I2C1, I2C_FLAG_BUSY) != RESET) && timeout--);
|
||||||
if (!timeout) return -1;
|
if (!timeout) return -1;
|
||||||
|
|
||||||
|
I2C_AcknowledgeConfig(I2C1, ENABLE);
|
||||||
|
|
||||||
I2C_GenerateSTART(I2C1, ENABLE);
|
I2C_GenerateSTART(I2C1, ENABLE);
|
||||||
timeout = I2C_TIMEOUT;
|
timeout = I2C_TIMEOUT;
|
||||||
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT) && timeout--);
|
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT) && timeout--);
|
||||||
|
@ -124,6 +125,11 @@ int8_t i2c_write_addr1b(uint8_t addr, uint8_t reg, const uint8_t *data, uint8_t
|
||||||
I2C_SendData(I2C1, *data++);
|
I2C_SendData(I2C1, *data++);
|
||||||
len--;
|
len--;
|
||||||
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_BYTE_TRANSMITTED));
|
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_BYTE_TRANSMITTED));
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
// failed to acknowledge...
|
||||||
|
if (I2C_GetFlagStatus(I2C1, I2C_FLAG_AF)) {
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -132,14 +138,20 @@ int8_t i2c_write_addr1b(uint8_t addr, uint8_t reg, const uint8_t *data, uint8_t
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
void i2c_write_reg_8b(uint8_t addr, uint8_t reg, uint8_t dat)
|
void i2c_write_reg_8b(uint8_t addr, uint8_t reg, const uint8_t dat)
|
||||||
{
|
{
|
||||||
i2c_write_addr1b(addr, reg, &dat, 1);
|
i2c_write_addr1b(addr, reg, &dat, 1);
|
||||||
}
|
}
|
||||||
|
|
||||||
int8_t i2c_ack_poll(uint8_t addr)
|
int8_t i2c_addr_scan(uint8_t addr)
|
||||||
{
|
{
|
||||||
int8_t addr_match = 0;
|
uint8_t found = 1;
|
||||||
|
uint32_t event;
|
||||||
|
|
||||||
|
// no low addresses
|
||||||
|
if ((addr >> 4) == 0) return 0;
|
||||||
|
// no high addresses
|
||||||
|
if ((addr & 0xf8) == 0xf8) return 0;
|
||||||
|
|
||||||
timeout = I2C_TIMEOUT;
|
timeout = I2C_TIMEOUT;
|
||||||
while((I2C_GetFlagStatus(I2C1, I2C_FLAG_BUSY) != RESET) && timeout--);
|
while((I2C_GetFlagStatus(I2C1, I2C_FLAG_BUSY) != RESET) && timeout--);
|
||||||
|
@ -150,14 +162,30 @@ int8_t i2c_ack_poll(uint8_t addr)
|
||||||
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT) && timeout--);
|
while(!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT) && timeout--);
|
||||||
if (!timeout) return -2;
|
if (!timeout) return -2;
|
||||||
|
|
||||||
I2C_Send7bitAddress(I2C1, addr, I2C_Direction_Receiver);
|
I2C_Send7bitAddress(I2C1, (addr & 0xfe), (addr & 0x01));
|
||||||
timeout = I2C_TIMEOUT_ACK_POLL;
|
timeout = I2C_TIMEOUT_ACK_POLL;
|
||||||
while (!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_RECEIVER_MODE_SELECTED) && timeout--);
|
if (addr & 1) event = I2C_EVENT_MASTER_RECEIVER_MODE_SELECTED;
|
||||||
if (!timeout) {
|
else event = I2C_EVENT_MASTER_TRANSMITTER_MODE_SELECTED;
|
||||||
addr_match = -128;
|
|
||||||
|
while ((I2C_CheckEvent(I2C1, event) == NoREADY) && timeout--) {
|
||||||
|
if (I2C_GetFlagStatus(I2C1, I2C_FLAG_AF)) {
|
||||||
|
found = 0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (!timeout) {
|
||||||
|
found = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
// send a stop to make sure anything listening knows to stfu
|
||||||
I2C_GenerateSTOP(I2C1, ENABLE);
|
I2C_GenerateSTOP(I2C1, ENABLE);
|
||||||
|
|
||||||
return addr_match;
|
// reset flags; it might be in a fucked state
|
||||||
|
if (!found) {
|
||||||
|
I2C1->STAR1 = 0;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
return addr;
|
||||||
}
|
}
|
||||||
|
|
|
@ -1,8 +1,5 @@
|
||||||
/*
|
/*
|
||||||
* i2c.h
|
* Created on: Jul 27, 2024
|
||||||
*
|
|
||||||
* Created on: Jul 27, 2024
|
|
||||||
* Author: true
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef USER_SRC_I2C_H_
|
#ifndef USER_SRC_I2C_H_
|
||||||
|
@ -20,9 +17,9 @@ int8_t i2c_read_addr1b(uint8_t addr, uint8_t reg, uint8_t *data, uint8_t len);
|
||||||
int8_t i2c_write_addr1b(uint8_t addr, uint8_t reg, const uint8_t *data, uint8_t len);
|
int8_t i2c_write_addr1b(uint8_t addr, uint8_t reg, const uint8_t *data, uint8_t len);
|
||||||
|
|
||||||
uint8_t i2c_read_reg_8b(uint8_t addr, uint8_t reg);
|
uint8_t i2c_read_reg_8b(uint8_t addr, uint8_t reg);
|
||||||
void i2c_write_reg_8b(uint8_t addr, uint8_t reg, uint8_t dat);
|
void i2c_write_reg_8b(uint8_t addr, uint8_t reg, const uint8_t dat);
|
||||||
|
|
||||||
int8_t i2c_ack_poll(uint8_t devaddr);
|
int8_t i2c_addr_scan(uint8_t addr);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue