clockworkpi/PicoCalc
1
0
Fork 0
mirror of https://github.com/clockworkpi/PicoCalc.git synced 2026-03-21 11:32:38 +01:00
Code Issues Actions Packages Projects Releases Wiki Activity

sd_boot: handle bootmode

Browse Source
This commit is contained in:
Yatao Li
2025-06-15 02:50:03 +08:00
parent 44615ce5d2
commit fa3ad399d7
4 changed files with 78 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
Code/pico_multi_booter/sd_boot/i2ckbd/i2ckbd.c
View File

@@ -83,3 +83,25 @@ int read_battery() {
}
return -1;
}
int read_bootmode() {
int retval;
unsigned char msg[2];
msg[0] = 0x0e; // REG_ID_BOOT
if (i2c_inited == 0) return -1;
retval = i2c_write_timeout_us(I2C_KBD_MOD, I2C_KBD_ADDR, msg, 1, false, 500000);
if (retval == PICO_ERROR_GENERIC || retval == PICO_ERROR_TIMEOUT) {
DEBUG_PRINT("Boot I2C write err\n");
return -1;
}
sleep_ms(16);
retval = i2c_read_timeout_us(I2C_KBD_MOD, I2C_KBD_ADDR, (unsigned char *) msg, 2, false, 500000);
if (retval == PICO_ERROR_GENERIC || retval == PICO_ERROR_TIMEOUT || msg[0] != 0x0e) {
DEBUG_PRINT("Boot I2C read err\n");
return -1;
}
return msg[1];
}

3
Code/pico_multi_booter/sd_boot/i2ckbd/i2ckbd.h
View File

@@ -16,9 +16,10 @@
void init_i2c_kbd();
int read_i2c_kbd();
int read_battery();
int read_bootmode();
#define bitRead(value, bit) (((value) >> (bit)) & 0x01)
#define bitClear(value, bit) ((value) &= ~(1 << (bit)))
#define bitSet(value, bit) ((value) |= (1 << (bit)))
#endif
#endif