diff options
| author | Timofey Titovets <nefelim4ag@gmail.com> | 2025-03-25 21:13:58 +0100 |
|---|---|---|
| committer | KevinOConnor <kevin@koconnor.net> | 2025-04-17 11:41:49 -0400 |
| commit | 8ab12c86bfa843ee317b0ec539d9713cc960c8ee (patch) | |
| tree | 67b219901492de42260ebdeda2ca26788c844710 | |
| parent | abc76ee963d4154dce0bd56f2fdb946d5065cc86 (diff) | |
| download | kutter-8ab12c86bfa843ee317b0ec539d9713cc960c8ee.tar.gz kutter-8ab12c86bfa843ee317b0ec539d9713cc960c8ee.tar.xz kutter-8ab12c86bfa843ee317b0ec539d9713cc960c8ee.zip | |
i2c_software: allow freq adjust
Signed-off-by: Timofey Titovets <nefelim4ag@gmail.com>
| -rw-r--r-- | src/i2c_software.c | 7 |
1 files changed, 7 insertions, 0 deletions
diff --git a/src/i2c_software.c b/src/i2c_software.c index 99094864..77da9447 100644 --- a/src/i2c_software.c +++ b/src/i2c_software.c @@ -26,12 +26,19 @@ command_i2c_set_software_bus(uint32_t *args) { struct i2cdev_s *i2c = i2cdev_oid_lookup(args[0]); struct i2c_software *is = alloc_chunk(sizeof(*is)); + uint32_t rate = args[3]; is->ticks = CONFIG_CLOCK_FREQ / (100000 * 2); // 100KHz is->addr = (args[4] & 0x7f) << 1; // address format shifted is->scl_in = gpio_in_setup(args[1], 1); is->scl_out = gpio_out_setup(args[1], 1); is->sda_in = gpio_in_setup(args[2], 1); is->sda_out = gpio_out_setup(args[2], 1); + while (rate > 100000) { + rate = rate >> 1; + if (rate < 100000) + break; + is->ticks = is->ticks >> 1; + } i2cdev_set_software_bus(i2c, is); } DECL_COMMAND(command_i2c_set_software_bus, |