I2c led

[apps/native/gear-racing-car.git] / src / resource / resource_PCA9685.c

diff --git a/src/resource/resource_PCA9685.c b/src/resource/resource_PCA9685.c
index 20a5545..e7edffc 100644 (file)
--- a/src/resource/resource_PCA9685.c
+++ b/src/resource/resource_PCA9685.c
@@ -102,20 +102,16 @@ int resource_pca9685_set_value_to_channel(unsigned int channel, int on, int off)
        retvm_if(ch_state[channel] == PCA9685_CH_STATE_NONE, -1,
                "ch[%u] is not in used state", channel);
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-                       LED0_ON_L + 4*channel, on & 0xFF);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, LED0_ON_L + 4*channel, on & 0xFF);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-                       LED0_ON_H + 4*channel, on >> 8);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, LED0_ON_H + 4*channel, on >> 8);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-                       LED0_OFF_L + 4*channel, off & 0xFF);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, LED0_OFF_L + 4*channel, off & 0xFF);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-                       LED0_OFF_H + 4*channel, off >> 8);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, LED0_OFF_H + 4*channel, off >> 8);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
        return 0;
@@ -126,26 +122,22 @@ static int resource_pca9685_set_value_to_all(int on, int off)
        int ret = PERIPHERAL_ERROR_NONE;
        retvm_if(g_i2c_h == NULL, -1, "Not initialized yet");
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-               ALL_LED_ON_L, on & 0xFF);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, ALL_LED_ON_L, on & 0xFF);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-               ALL_LED_ON_H, on >> 8);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, ALL_LED_ON_H, on >> 8);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-               ALL_LED_OFF_L, off & 0xFF);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, ALL_LED_OFF_L, off & 0xFF);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
-       ret = peripheral_i2c_write_register_byte(g_i2c_h,
-               ALL_LED_OFF_H, off >> 8);
+       ret = peripheral_i2c_write_register_byte(g_i2c_h, ALL_LED_OFF_H, off >> 8);
        retvm_if(ret != PERIPHERAL_ERROR_NONE, -1, "failed to write register");
 
        return 0;
 }
 
-int resource_pca9685_init(unsigned int ch)
+int resource_pca9685_init(unsigned int ch, unsigned int freq)
 {
        uint8_t mode1 = 0;
        int ret = PERIPHERAL_ERROR_NONE;
@@ -165,8 +157,7 @@ int resource_pca9685_init(unsigned int ch)
 
        ret = peripheral_i2c_open(RPI3_I2C_BUS, PCA9685_ADDRESS, &g_i2c_h);
        if (ret != PERIPHERAL_ERROR_NONE) {
-               _E("failed to open pca9685-[bus:%d, addr:%d]",
-                       RPI3_I2C_BUS, PCA9685_ADDRESS);
+               _E("failed to open pca9685-[bus:%d, addr:%d]", RPI3_I2C_BUS, PCA9685_ADDRESS);
                return -1;
        }
        ret = resource_pca9685_set_value_to_all(0, 0);
@@ -204,7 +195,7 @@ int resource_pca9685_init(unsigned int ch)
 
        usleep(500); // wait for oscillator
 
-       ret = resource_pca9685_set_frequency(60);
+       ret = resource_pca9685_set_frequency(freq);
        if (ret) {
                _E("failed to set frequency");
                goto ERROR;