run watch at 4 MHz unless USB is enabled

This commit is contained in:
Joey Castillo
2021-08-30 17:35:47 -04:00
parent eb3d9b26cb
commit fbd9ae4b67
4 changed files with 17 additions and 6 deletions

View File

@@ -167,7 +167,8 @@ static inline uint32_t _get_cycles_for_us_internal(const uint16_t us, const uint
*/
uint32_t _get_cycles_for_us(const uint16_t us)
{
return _get_cycles_for_us_internal(us, CONF_CPU_FREQUENCY, CPU_FREQ_POWER);
int32_t freq = hri_usbdevice_get_CTRLA_ENABLE_bit(USB) ? 8000000 : 4000000;
return _get_cycles_for_us_internal(us, freq, CPU_FREQ_POWER);
}
/**
@@ -196,5 +197,6 @@ static inline uint32_t _get_cycles_for_ms_internal(const uint16_t ms, const uint
*/
uint32_t _get_cycles_for_ms(const uint16_t ms)
{
return _get_cycles_for_ms_internal(ms, CONF_CPU_FREQUENCY, CPU_FREQ_POWER);
int32_t freq = hri_usbdevice_get_CTRLA_ENABLE_bit(USB) ? 8000000 : 4000000;
return _get_cycles_for_ms_internal(ms, freq, CPU_FREQ_POWER);
}