我正在尝试使用 adafruit PWM 伺服控制器控制多个伺服系统。它使用 i2c 接口与微控制器进行通信。 https://www.adafruit.com/product/815
我正在使用 Atmega 168 尝试使用简单的 i2c 库将 i2c 指令发送到微控制器。
#include "i2c.h"
void initI2C(void) {
TWBR = 32; /* set bit rate, see p. 242 */
/* 8MHz / (16+2*TWBR*1) ~= 100kHz */
TWCR |= (1 << TWEN); /* enable */
}
void i2cWaitForComplete(void) {
loop_until_bit_is_set(TWCR, TWINT);
}
void i2cStart(void) {
TWCR = (_BV(TWINT) | _BV(TWEN) | _BV(TWSTA));
i2cWaitForComplete();
}
void i2cStop(void) {
TWCR = (_BV(TWINT) | _BV(TWEN) | _BV(TWSTO));
}
uint8_t i2cReadAck(void) {
TWCR = (_BV(TWINT) | _BV(TWEN) | _BV(TWEA));
i2cWaitForComplete();
return (TWDR);
}
uint8_t i2cReadNoAck(void) {
TWCR = (_BV(TWINT) | _BV(TWEN));
i2cWaitForComplete();
return (TWDR);
}
void i2cSend(uint16_t data) {
TWDR = data;
TWCR = (_BV(TWINT) | _BV(TWEN)); /* init and enable */
i2cWaitForComplete();
}
我从 Arduino 驱动程序中找到了伺服控制器的地址,但在设置板的 PWM 时遇到问题。这是我尝试使用的代码:
#include <avr/io.h>
#include <util/delay.h>
#include <avr/interrupt.h>
#include "i2c.h"
#define SERVO_MIN 1000
#define SERVO_MAX 2000
#define SERVO_MID 1500
#define PCA9685_ADDR 0x4
#define PCA9685_MODE1 0x0
#define LED0_ON_L 0x6
#define LED0_ON_H 0x7
#define LED0_OFF_L 0x8
#define LED0_OFF_H 0x9
int main(void)
{
initI2C();
setupController();
for(int i = 1; i < 17; i++) {
setServo(i, 0, 4026);
}
return 0;
}
void setupController() {
i2cStart();
i2cSend(PCA9685_ADDR);
i2cSend(PCA9685_MODE1);
i2cSend(0x0);
i2cStop();
}
void setServo(uint8_t id, uint16_t start, uint16_t stop) {
i2cStart();
i2cSend(PCA9685_ADDR);
i2cSend(LED0_ON_L+4*id);
i2cSend(start);
i2cSend(start>>8);
i2cSend(stop);
i2cSend(stop>>8);
i2cStop();
}
这是驱动程序:https ://github.com/adafruit/Adafruit-PWM-Servo-Driver-Library
我很确定我的 i2c 设置不正确?有什么建议么?
谢谢!:)