You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
117 lines
3.0 KiB
117 lines
3.0 KiB
2 years ago
|
// /////////////////
|
||
|
|
// Tres + Harness //
|
||
|
|
// /////////////////
|
||
|
|
|
||
|
|
bool tres_ir_enabled;
|
||
|
|
bool tres_fan_enabled;
|
||
|
|
void tres_update_fan_ir_power(void) {
|
||
|
|
red_chiplet_set_fan_or_usb_load_switch(tres_ir_enabled || tres_fan_enabled);
|
||
|
|
}
|
||
|
|
|
||
|
|
void tres_set_ir_power(uint8_t percentage){
|
||
|
|
tres_ir_enabled = (percentage > 0U);
|
||
|
|
tres_update_fan_ir_power();
|
||
|
|
pwm_set(TIM3, 4, percentage);
|
||
|
|
}
|
||
|
|
|
||
|
|
void tres_set_bootkick(bool enabled){
|
||
|
|
set_gpio_output(GPIOA, 0, !enabled);
|
||
|
|
}
|
||
|
|
|
||
|
|
bool tres_ignition_prev = false;
|
||
|
|
bool tres_board_tick(bool ignition, bool usb_enum, bool heartbeat_seen, bool harness_inserted) {
|
||
|
|
UNUSED(usb_enum);
|
||
|
|
bool ret = false;
|
||
|
|
if ((ignition && !tres_ignition_prev) || harness_inserted) {
|
||
|
|
// enable bootkick on rising edge of ignition
|
||
|
|
ret = true;
|
||
|
|
tres_set_bootkick(true);
|
||
|
|
} else if (heartbeat_seen) {
|
||
|
|
// disable once openpilot is up
|
||
|
|
tres_set_bootkick(false);
|
||
|
|
} else {
|
||
|
|
|
||
|
|
}
|
||
|
|
tres_ignition_prev = ignition;
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
void tres_set_fan_enabled(bool enabled) {
|
||
|
|
// NOTE: fan controller reset doesn't work on a tres if IR is enabled
|
||
|
|
tres_fan_enabled = enabled;
|
||
|
|
tres_update_fan_ir_power();
|
||
|
|
}
|
||
|
|
|
||
|
|
bool tres_read_som_gpio (void){
|
||
|
|
return (get_gpio_input(GPIOC, 2) != 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
void tres_init(void) {
|
||
|
|
// Enable USB 3.3V LDO for USB block
|
||
|
|
register_set_bits(&(PWR->CR3), PWR_CR3_USBREGEN);
|
||
|
|
register_set_bits(&(PWR->CR3), PWR_CR3_USB33DEN);
|
||
|
|
while ((PWR->CR3 & PWR_CR3_USB33RDY) == 0);
|
||
|
|
|
||
|
|
red_chiplet_init();
|
||
|
|
|
||
|
|
// C2: SOM GPIO used as input (fan control at boot)
|
||
|
|
set_gpio_mode(GPIOC, 2, MODE_INPUT);
|
||
|
|
set_gpio_pullup(GPIOC, 2, PULL_DOWN);
|
||
|
|
|
||
|
|
tres_set_bootkick(true);
|
||
|
|
|
||
|
|
// SOM debugging UART
|
||
|
|
gpio_uart7_init();
|
||
|
|
uart_init(&uart_ring_som_debug, 115200);
|
||
|
|
|
||
|
|
// SPI init
|
||
|
|
gpio_spi_init();
|
||
|
|
|
||
|
|
// fan setup
|
||
|
|
set_gpio_alternate(GPIOC, 8, GPIO_AF2_TIM3);
|
||
|
|
|
||
|
|
// Initialize IR PWM and set to 0%
|
||
|
|
set_gpio_alternate(GPIOC, 9, GPIO_AF2_TIM3);
|
||
|
|
pwm_init(TIM3, 4);
|
||
|
|
tres_set_ir_power(0U);
|
||
|
|
|
||
|
|
// Fake siren
|
||
|
|
set_gpio_alternate(GPIOC, 10, GPIO_AF4_I2C5);
|
||
|
|
set_gpio_alternate(GPIOC, 11, GPIO_AF4_I2C5);
|
||
|
|
register_set_bits(&(GPIOC->OTYPER), GPIO_OTYPER_OT10 | GPIO_OTYPER_OT11); // open drain
|
||
|
|
fake_siren_init();
|
||
|
|
|
||
|
|
// Clock source
|
||
|
|
clock_source_init();
|
||
|
|
}
|
||
|
|
|
||
|
|
const board board_tres = {
|
||
|
|
.board_type = "Tres",
|
||
|
|
.board_tick = tres_board_tick,
|
||
|
|
.harness_config = &red_chiplet_harness_config,
|
||
|
|
.has_gps = false,
|
||
|
|
.has_hw_gmlan = false,
|
||
|
|
.has_obd = true,
|
||
|
|
.has_lin = false,
|
||
|
|
.has_spi = true,
|
||
|
|
.has_canfd = true,
|
||
|
|
.has_rtc_battery = true,
|
||
|
|
.fan_max_rpm = 6600U,
|
||
|
|
.avdd_mV = 1800U,
|
||
|
|
.fan_stall_recovery = false,
|
||
|
|
.fan_enable_cooldown_time = 3U,
|
||
|
|
.init = tres_init,
|
||
|
|
.enable_can_transceiver = red_chiplet_enable_can_transceiver,
|
||
|
|
.enable_can_transceivers = red_chiplet_enable_can_transceivers,
|
||
|
|
.set_led = red_set_led,
|
||
|
|
.set_gps_mode = unused_set_gps_mode,
|
||
|
|
.set_can_mode = red_set_can_mode,
|
||
|
|
.check_ignition = red_check_ignition,
|
||
|
|
.read_current = unused_read_current,
|
||
|
|
.set_fan_enabled = tres_set_fan_enabled,
|
||
|
|
.set_ir_power = tres_set_ir_power,
|
||
|
|
.set_phone_power = unused_set_phone_power,
|
||
|
|
.set_siren = fake_siren_set,
|
||
|
|
.read_som_gpio = tres_read_som_gpio
|
||
|
|
};
|