@ -1,14 +1,15 @@
//#define EON
# include "config.h"
# include "obj/gitversion.h"
// ********************* includes *********************
# include "libc.h"
# include "safety.h"
# include "provision.h"
# include "drivers/drivers.h"
# include "drivers/llcan.h"
# include "drivers/llgpio.h"
# include "gpio.h"
@ -16,25 +17,13 @@
# include "drivers/adc.h"
# include "drivers/usb.h"
# include "drivers/gmlan_alt.h"
# include "drivers/can.h"
# include "drivers/spi.h"
# include "drivers/timer.h"
# include "drivers/clock.h"
# include "power_saving.h"
// ***************************** fan *****************************
void fan_init ( ) {
// timer for fan PWM
TIM3 - > CCMR2 = TIM_CCMR2_OC3M_2 | TIM_CCMR2_OC3M_1 ;
TIM3 - > CCER = TIM_CCER_CC3E ;
timer_init ( TIM3 , 10 ) ;
}
void fan_set_speed ( int fan_speed ) {
TIM3 - > CCR3 = fan_speed ;
}
# include "safety.h"
# include "drivers/can.h"
// ********************* serial debugging *********************
@ -70,6 +59,41 @@ void debug_ring_callback(uart_ring *ring) {
}
}
// ***************************** started logic *****************************
int is_gpio_started ( ) {
// ignition is on PA1
return ( GPIOA - > IDR & ( 1 < < 1 ) ) = = 0 ;
}
void EXTI1_IRQHandler ( ) {
volatile int pr = EXTI - > PR & ( 1 < < 1 ) ;
if ( pr & ( 1 < < 1 ) ) {
# ifdef DEBUG
puts ( " got started interrupt \n " ) ;
# endif
// jenky debounce
delay ( 100000 ) ;
// set power savings mode here
if ( is_gpio_started ( ) = = 1 ) {
power_save_disable ( ) ;
} else {
power_save_enable ( ) ;
}
EXTI - > PR = ( 1 < < 1 ) ;
}
}
void started_interrupt_init ( ) {
SYSCFG - > EXTICR [ 1 ] = SYSCFG_EXTICR1_EXTI1_PA ;
EXTI - > IMR | = ( 1 < < 1 ) ;
EXTI - > RTSR | = ( 1 < < 1 ) ;
EXTI - > FTSR | = ( 1 < < 1 ) ;
NVIC_EnableIRQ ( EXTI1_IRQn ) ;
}
// ***************************** USB port *****************************
int get_health_pkt ( void * dat ) {
@ -85,40 +109,25 @@ int get_health_pkt(void *dat) {
//Voltage will be measured in mv. 5000 = 5V
uint32_t voltage = adc_get ( ADCCHAN_VOLTAGE ) ;
if ( revision = = PANDA_REV_AB ) {
//REVB has a 100, 27 (27/127) voltage divider
//Here is the calculation for the scale
//ADCV = VIN_S * (27/127) * (4095/3.3)
//RETVAL = ADCV * s = VIN_S*1000
//s = 1000/((4095/3.3)*(27/127)) = 3.79053046
//Avoid needing floating point math
health - > voltage = ( voltage * 3791 ) / 1000 ;
} else {
//REVC has a 10, 1 (1/11) voltage divider
//Here is the calculation for the scale (s)
//ADCV = VIN_S * (1/11) * (4095/3.3)
//RETVAL = ADCV * s = VIN_S*1000
//s = 1000/((4095/3.3)*(1/11)) = 8.8623046875
//Avoid needing floating point math
health - > voltage = ( voltage * 8862 ) / 1000 ;
}
# ifdef PANDA
// REVC has a 10, 1 (1/11) voltage divider
// Here is the calculation for the scale (s)
// ADCV = VIN_S * (1/11) * (4095/3.3)
// RETVAL = ADCV * s = VIN_S*1000
// s = 1000/((4095/3.3)*(1/11)) = 8.8623046875
// Avoid needing floating point math
health - > voltage = ( voltage * 8862 ) / 1000 ;
health - > current = adc_get ( ADCCHAN_CURRENT ) ;
int safety_ignition = safety_ignition_hook ( ) ;
if ( safety_ignition < 0 ) {
//Use the GPIO pin to determine ignition
health - > started = ( GPIOA - > IDR & ( 1 < < 1 ) ) = = 0 ;
health - > started = is_gpio_started ( ) ;
} else {
//Current safety hooks want to determine ignition (ex: GM)
health - > started = safety_ignition ;
}
# else
health - > current = 0 ;
health - > started = ( GPIOC - > IDR & ( 1 < < 13 ) ) ! = 0 ;
# endif
health - > controls_allowed = controls_allowed ;
health - > gas_interceptor_detected = gas_interceptor_detected ;
@ -143,7 +152,6 @@ void usb_cb_ep2_out(uint8_t *usbdata, int len, int hardwired) {
uart_ring * ur = get_ring_by_number ( usbdata [ 0 ] ) ;
if ( ! ur ) return ;
if ( ( usbdata [ 0 ] < 2 ) | | safety_tx_lin_hook ( usbdata [ 0 ] - 2 , usbdata + 1 , len - 1 ) ) {
if ( ur = = & esp_ring ) power_save_reset_timer ( ) ;
for ( int i = 1 ; i < len ; i + + ) while ( ! putc ( ur , usbdata [ i ] ) ) ;
}
}
@ -163,14 +171,6 @@ void usb_cb_ep3_out(uint8_t *usbdata, int len, int hardwired) {
uint8_t bus_number = ( to_push . RDTR > > 4 ) & CAN_BUS_NUM_MASK ;
can_send ( & to_push , bus_number ) ;
# ifdef PANDA
// Enable relay on can message if allowed.
// Temporary until OP has support for relay
if ( safety_relay_hook ( ) ) {
set_lline_output ( 1 ) ;
}
# endif
}
}
@ -201,16 +201,14 @@ int usb_cb_control_msg(USB_Setup_TypeDef *setup, uint8_t *resp, int hardwired) {
break ;
// **** 0xd0: fetch serial number
case 0xd0 :
# ifdef PANDA
// addresses are OTP
if ( setup - > b . wValue . w = = 1 ) {
memcpy ( resp , ( void * ) 0x1fff79c0 , 0x10 ) ;
resp_len = 0x10 ;
} else {
get_provision_chunk ( resp ) ;
resp_len = PROVISION_CHUNK_LEN ;
}
# endif
// addresses are OTP
if ( setup - > b . wValue . w = = 1 ) {
memcpy ( resp , ( void * ) 0x1fff79c0 , 0x10 ) ;
resp_len = 0x10 ;
} else {
get_provision_chunk ( resp ) ;
resp_len = PROVISION_CHUNK_LEN ;
}
break ;
// **** 0xd1: enter bootloader mode
case 0xd1 :
@ -235,10 +233,6 @@ int usb_cb_control_msg(USB_Setup_TypeDef *setup, uint8_t *resp, int hardwired) {
case 0xd2 :
resp_len = get_health_pkt ( resp ) ;
break ;
// **** 0xd3: set fan speed
case 0xd3 :
fan_set_speed ( setup - > b . wValue . w ) ;
break ;
// **** 0xd6: get version
case 0xd6 :
COMPILE_TIME_ASSERT ( sizeof ( gitversion ) < = MAX_RESP_LEN )
@ -273,44 +267,43 @@ int usb_cb_control_msg(USB_Setup_TypeDef *setup, uint8_t *resp, int hardwired) {
break ;
// **** 0xdb: set GMLAN multiplexing mode
case 0xdb :
# ifdef PANDA
if ( setup - > b . wValue . w = = 1 ) {
// GMLAN ON
if ( setup - > b . wIndex . w = = 1 ) {
can_set_gmlan ( 1 ) ;
} else if ( setup - > b . wIndex . w = = 2 ) {
// might be ignored on rev b panda
can_set_gmlan ( 2 ) ;
}
} else {
can_set_gmlan ( - 1 ) ;
if ( setup - > b . wValue . w = = 1 ) {
// GMLAN ON
if ( setup - > b . wIndex . w = = 1 ) {
can_set_gmlan ( 1 ) ;
} else if ( setup - > b . wIndex . w = = 2 ) {
can_set_gmlan ( 2 ) ;
}
# endif
} else {
can_set_gmlan ( - 1 ) ;
}
break ;
// **** 0xdc: set safety mode
case 0xdc :
// this is the only way to leave silent mode
// and it's blocked over WiFi
// Allow ELM security mode to be set over wifi.
if ( hardwired | | setup - > b . wValue . w = = SAFETY_NOOUTPUT | | setup - > b . wValue . w = = SAFETY_ELM327 ) {
if ( hardwired | | ( setup - > b . wValue . w = = SAFETY_NOOUTPUT ) | | ( setup - > b . wValue . w = = SAFETY_ELM327 ) ) {
safety_set_mode ( setup - > b . wValue . w , ( int16_t ) setup - > b . wIndex . w ) ;
switch ( setup - > b . wValue . w ) {
case SAFETY_NOOUTPUT :
can_silent = ALL_CAN_SILENT ;
break ;
case SAFETY_ELM327 :
can_silent = ALL_CAN_BUT_MAIN_SILENT ;
can_autobaud_enabled [ 0 ] = false ;
break ;
default :
can_silent = ALL_CAN_LIVE ;
can_autobaud_enabled [ 0 ] = false ;
can_autobaud_enabled [ 1 ] = false ;
# ifdef PANDA
can_autobaud_enabled [ 2 ] = false ;
# endif
break ;
if ( safety_ignition_hook ( ) ! = - 1 ) {
// if the ignition hook depends on something other than the started GPIO
// we have to disable power savings (fix for GM and Tesla)
power_save_disable ( ) ;
}
# ifndef EON
// always LIVE on EON
switch ( setup - > b . wValue . w ) {
case SAFETY_NOOUTPUT :
can_silent = ALL_CAN_SILENT ;
break ;
case SAFETY_ELM327 :
can_silent = ALL_CAN_BUT_MAIN_SILENT ;
break ;
default :
can_silent = ALL_CAN_LIVE ;
break ;
}
# endif
can_init_all ( ) ;
}
break ;
@ -318,21 +311,26 @@ int usb_cb_control_msg(USB_Setup_TypeDef *setup, uint8_t *resp, int hardwired) {
case 0xdd :
// wValue = Can Bus Num to forward from
// wIndex = Can Bus Num to forward to
if ( setup - > b . wValue . w < BUS_MAX & & setup - > b . wIndex . w < BUS_MAX & &
setup - > b . wValue . w ! = setup - > b . wIndex . w ) { // set forwarding
if ( ( setup - > b . wValue . w < BUS_MAX ) & & ( setup - > b . wIndex . w < BUS_MAX ) & &
( setup - > b . wValue . w ! = setup - > b . wIndex . w ) ) { // set forwarding
can_set_forwarding ( setup - > b . wValue . w , setup - > b . wIndex . w & CAN_BUS_NUM_MASK ) ;
} else if ( setup - > b . wValue . w < BUS_MAX & & setup - > b . wIndex . w = = 0xFF ) { //Clear Forwarding
} else if ( ( setup - > b . wValue . w < BUS_MAX ) & & ( setup - > b . wIndex . w = = 0xFF ) ) { //Clear Forwarding
can_set_forwarding ( setup - > b . wValue . w , - 1 ) ;
}
break ;
// **** 0xde: set can bitrate
case 0xde :
if ( setup - > b . wValue . w < BUS_MAX ) {
can_autobaud_enabled [ setup - > b . wValue . w ] = false ;
can_speed [ setup - > b . wValue . w ] = setup - > b . wIndex . w ;
can_init ( CAN_NUM_FROM_BUS_NUM ( setup - > b . wValue . w ) ) ;
}
break ;
// **** 0xdf: set long controls allowed
case 0xdf :
if ( hardwired ) {
long_controls_allowed = setup - > b . wValue . w & 1 ;
}
break ;
// **** 0xe0: uart read
case 0xe0 :
ur = get_ring_by_number ( setup - > b . wValue . w ) ;
@ -386,17 +384,15 @@ int usb_cb_control_msg(USB_Setup_TypeDef *setup, uint8_t *resp, int hardwired) {
break ;
// **** 0xe6: set USB power
case 0xe6 :
if ( revision = = PANDA_REV_C ) {
if ( setup - > b . wValue . w = = 1 ) {
puts ( " user setting CDP mode \n " ) ;
set_usb_power_mode ( USB_POWER_CDP ) ;
} else if ( setup - > b . wValue . w = = 2 ) {
puts ( " user setting DCP mode \n " ) ;
set_usb_power_mode ( USB_POWER_DCP ) ;
} else {
puts ( " user setting CLIENT mode \n " ) ;
set_usb_power_mode ( USB_POWER_CLIENT ) ;
}
if ( setup - > b . wValue . w = = 1 ) {
puts ( " user setting CDP mode \n " ) ;
set_usb_power_mode ( USB_POWER_CDP ) ;
} else if ( setup - > b . wValue . w = = 2 ) {
puts ( " user setting DCP mode \n " ) ;
set_usb_power_mode ( USB_POWER_DCP ) ;
} else {
puts ( " user setting CLIENT mode \n " ) ;
set_usb_power_mode ( USB_POWER_CLIENT ) ;
}
break ;
// **** 0xf0: do k-line wValue pulse on uart2 for Acura
@ -452,16 +448,6 @@ int usb_cb_control_msg(USB_Setup_TypeDef *setup, uint8_t *resp, int hardwired) {
}
break ;
}
// **** 0xf3: set l-line relay
case 0xf3 :
{
# ifdef PANDA
if ( safety_relay_hook ( ) ) {
set_lline_output ( setup - > b . wValue . w = = 1 ) ;
}
# endif
break ;
}
default :
puts ( " NO HANDLER " ) ;
puth ( setup - > b . bRequest ) ;
@ -471,7 +457,6 @@ int usb_cb_control_msg(USB_Setup_TypeDef *setup, uint8_t *resp, int hardwired) {
return resp_len ;
}
# ifdef PANDA
int spi_cb_rx ( uint8_t * data , int len , uint8_t * data_out ) {
// data[0] = endpoint
// data[2] = length
@ -499,12 +484,6 @@ int spi_cb_rx(uint8_t *data, int len, uint8_t *data_out) {
return resp_len ;
}
# else
int spi_cb_rx ( uint8_t * data , int len , uint8_t * data_out ) { return 0 ; } ;
# endif
// ***************************** main code *****************************
@ -514,7 +493,99 @@ void __initialize_hardware_early() {
void __attribute__ ( ( noinline ) ) enable_fpu ( ) {
// enable the FPU
SCB - > CPACR | = ( ( 3UL < < 10 * 2 ) | ( 3UL < < 11 * 2 ) ) ;
SCB - > CPACR | = ( ( 3UL < < ( 10 * 2 ) ) | ( 3UL < < ( 11 * 2 ) ) ) ;
}
uint64_t tcnt = 0 ;
uint64_t marker = 0 ;
// called once per second
void TIM3_IRQHandler ( ) {
# define CURRENT_THRESHOLD 0xF00
# define CLICKS 5 // 5 seconds to switch modes
if ( TIM3 - > SR ! = 0 ) {
can_live = pending_can_live ;
//puth(usart1_dma); puts(" "); puth(DMA2_Stream5->M0AR); puts(" "); puth(DMA2_Stream5->NDTR); puts("\n");
uint32_t current = adc_get ( ADCCHAN_CURRENT ) ;
switch ( usb_power_mode ) {
case USB_POWER_CLIENT :
if ( ( tcnt - marker ) > = CLICKS ) {
if ( ! is_enumerated ) {
puts ( " USBP: didn't enumerate, switching to CDP mode \n " ) ;
// switch to CDP
set_usb_power_mode ( USB_POWER_CDP ) ;
marker = tcnt ;
}
}
// keep resetting the timer if it's enumerated
if ( is_enumerated ) {
marker = tcnt ;
}
break ;
case USB_POWER_CDP :
// On the EON, if we get into CDP mode we stay here. No need to go to DCP.
# ifndef EON
// been CLICKS clicks since we switched to CDP
if ( ( tcnt - marker ) > = CLICKS ) {
// measure current draw, if positive and no enumeration, switch to DCP
if ( ! is_enumerated & & ( current < CURRENT_THRESHOLD ) ) {
puts ( " USBP: no enumeration with current draw, switching to DCP mode \n " ) ;
set_usb_power_mode ( USB_POWER_DCP ) ;
marker = tcnt ;
}
}
// keep resetting the timer if there's no current draw in CDP
if ( current > = CURRENT_THRESHOLD ) {
marker = tcnt ;
}
# endif
break ;
case USB_POWER_DCP :
// been at least CLICKS clicks since we switched to DCP
if ( ( tcnt - marker ) > = CLICKS ) {
// if no current draw, switch back to CDP
if ( current > = CURRENT_THRESHOLD ) {
puts ( " USBP: no current draw, switching back to CDP mode \n " ) ;
set_usb_power_mode ( USB_POWER_CDP ) ;
marker = tcnt ;
}
}
// keep resetting the timer if there's current draw in DCP
if ( current < CURRENT_THRESHOLD ) {
marker = tcnt ;
}
break ;
}
// ~0x9a = 500 ma
/*puth(current);
puts ( " \n " ) ; */
// reset this every 16th pass
if ( ( tcnt & 0xF ) = = 0 ) pending_can_live = 0 ;
# ifdef DEBUG
puts ( " ** blink " ) ;
puth ( can_rx_q . r_ptr ) ; puts ( " " ) ; puth ( can_rx_q . w_ptr ) ; puts ( " " ) ;
puth ( can_tx1_q . r_ptr ) ; puts ( " " ) ; puth ( can_tx1_q . w_ptr ) ; puts ( " " ) ;
puth ( can_tx2_q . r_ptr ) ; puts ( " " ) ; puth ( can_tx2_q . w_ptr ) ; puts ( " \n " ) ;
# endif
// set green LED to be controls allowed
set_led ( LED_GREEN , controls_allowed ) ;
// turn off the blue LED, turned on by CAN
// unless we are in power saving mode
set_led ( LED_BLUE , ( tcnt & 1 ) & & power_save_status = = POWER_SAVE_STATUS_ENABLED ) ;
// on to the next one
tcnt + = 1 ;
}
TIM3 - > SR = 0 ;
}
int main ( ) {
@ -531,21 +602,19 @@ int main() {
// detect the revision and init the GPIOs
puts ( " config: \n " ) ;
# ifdef PANDA
puts ( revision = = PANDA_REV_C ? " panda rev c \n " : " panda rev a or b \n " ) ;
# else
puts ( " legacy \n " ) ;
# endif
puts ( ( revision = = PANDA_REV_C ) ? " panda rev c \n " : " panda rev a or b \n " ) ;
puts ( has_external_debug_serial ? " real serial \n " : " USB serial \n " ) ;
puts ( is_giant_panda ? " GIANTpanda detected \n " : " not GIANTpanda \n " ) ;
puts ( is_grey_panda ? " gray panda detected! \n " : " white panda \n " ) ;
puts ( is_entering_bootmode ? " ESP wants bootmode \n " : " no bootmode \n " ) ;
// non rev c panda are no longer supported
while ( revision ! = PANDA_REV_C ) ;
gpio_init ( ) ;
# ifdef PANDA
// panda has an FPU, let's use it!
enable_fpu ( ) ;
# endif
// enable main uart if it's connected
if ( has_external_debug_serial ) {
@ -554,22 +623,18 @@ int main() {
uart_init ( USART2 , 115200 ) ;
}
# ifdef PANDA
if ( is_grey_panda ) {
uart_init ( USART1 , 9600 ) ;
} else {
// enable ESP uart
uart_init ( USART1 , 115200 ) ;
# ifdef EON
set_esp_mode ( ESP_DISABLED ) ;
# endif
}
// enable LIN
uart_init ( UART5 , 10400 ) ;
UART5 - > CR2 | = USART_CR2_LINEN ;
uart_init ( USART3 , 10400 ) ;
USART3 - > CR2 | = USART_CR2_LINEN ;
# endif
// init microsecond system timer
// increments 1000000 times per second
@ -585,136 +650,65 @@ int main() {
// default to silent mode to prevent issues with Ford
// hardcode a specific safety mode if you want to force the panda to be in a specific mode
safety_set_mode ( SAFETY_NOOUTPUT , 0 ) ;
# ifdef EON
// if we're on an EON, it's fine for CAN to be live for fingerprinting
can_silent = ALL_CAN_LIVE ;
# else
can_silent = ALL_CAN_SILENT ;
# endif
can_init_all ( ) ;
adc_init ( ) ;
# ifdef PANDA
spi_init ( ) ;
# ifdef EON
// have to save power
if ( ! is_grey_panda ) {
set_esp_mode ( ESP_DISABLED ) ;
}
// only enter power save after the first cycle
/*if (is_gpio_started() == 0) {
power_save_enable ( ) ;
} */
// interrupt on started line
started_interrupt_init ( ) ;
# endif
// 48mhz / 65536 ~= 732 / 732 = 1
timer_init ( TIM3 , 732 ) ;
NVIC_EnableIRQ ( TIM3_IRQn ) ;
# ifdef DEBUG
puts ( " DEBUG ENABLED \n " ) ;
# endif
// set PWM
fan_init ( ) ;
fan_set_speed ( 0 ) ;
puts ( " **** INTERRUPTS ON **** \n " ) ;
__enable_irq ( ) ;
power_save_init ( ) ;
// if the error interrupt is enabled to quickly when the CAN bus is active
// something bad happens and you can't connect to the device over USB
delay ( 10000000 ) ;
CAN1 - > IER | = CAN_IER_ERRIE | CAN_IER_LECIE ;
// LED should keep on blinking all the time
uint64_t cnt = 0 ;
# ifdef PANDA
uint64_t marker = 0 ;
# define CURRENT_THRESHOLD 0xF00
# define CLICKS 8
# endif
for ( cnt = 0 ; ; cnt + + ) {
can_live = pending_can_live ;
//puth(usart1_dma); puts(" "); puth(DMA2_Stream5->M0AR); puts(" "); puth(DMA2_Stream5->NDTR); puts("\n");
# ifdef PANDA
uint32_t current = adc_get ( ADCCHAN_CURRENT ) ;
switch ( usb_power_mode ) {
case USB_POWER_CLIENT :
if ( ( cnt - marker ) > = CLICKS ) {
if ( ! is_enumerated ) {
puts ( " USBP: didn't enumerate, switching to CDP mode \n " ) ;
// switch to CDP
set_usb_power_mode ( USB_POWER_CDP ) ;
marker = cnt ;
}
}
// keep resetting the timer if it's enumerated
if ( is_enumerated ) {
marker = cnt ;
}
break ;
case USB_POWER_CDP :
# ifndef EON
// been CLICKS clicks since we switched to CDP
if ( ( cnt - marker ) > = CLICKS ) {
// measure current draw, if positive and no enumeration, switch to DCP
if ( ! is_enumerated & & current < CURRENT_THRESHOLD ) {
puts ( " USBP: no enumeration with current draw, switching to DCP mode \n " ) ;
set_usb_power_mode ( USB_POWER_DCP ) ;
marker = cnt ;
}
}
// keep resetting the timer if there's no current draw in CDP
if ( current > = CURRENT_THRESHOLD ) {
marker = cnt ;
}
# endif
break ;
case USB_POWER_DCP :
// been at least CLICKS clicks since we switched to DCP
if ( ( cnt - marker ) > = CLICKS ) {
// if no current draw, switch back to CDP
if ( current > = CURRENT_THRESHOLD ) {
puts ( " USBP: no current draw, switching back to CDP mode \n " ) ;
set_usb_power_mode ( USB_POWER_CDP ) ;
marker = cnt ;
}
}
// keep resetting the timer if there's current draw in DCP
if ( current < CURRENT_THRESHOLD ) {
marker = cnt ;
if ( power_save_status = = POWER_SAVE_STATUS_DISABLED ) {
int div_mode = ( ( usb_power_mode = = USB_POWER_DCP ) ? 4 : 1 ) ;
// useful for debugging, fade breaks = panda is overloaded
for ( int div_mode_loop = 0 ; div_mode_loop < div_mode ; div_mode_loop + + ) {
for ( int fade = 0 ; fade < 1024 ; fade + = 8 ) {
for ( int i = 0 ; i < ( 128 / div_mode ) ; i + + ) {
set_led ( LED_RED , 1 ) ;
if ( fade < 512 ) { delay ( fade ) ; } else { delay ( 1024 - fade ) ; }
set_led ( LED_RED , 0 ) ;
if ( fade < 512 ) { delay ( 512 - fade ) ; } else { delay ( fade - 512 ) ; }
}
break ;
}
// ~0x9a = 500 ma
/*puth(current);
puts ( " \n " ) ; */
# endif
// reset this every 16th pass
if ( ( cnt & 0xF ) = = 0 ) pending_can_live = 0 ;
# ifdef DEBUG
puts ( " ** blink " ) ;
puth ( can_rx_q . r_ptr ) ; puts ( " " ) ; puth ( can_rx_q . w_ptr ) ; puts ( " " ) ;
puth ( can_tx1_q . r_ptr ) ; puts ( " " ) ; puth ( can_tx1_q . w_ptr ) ; puts ( " " ) ;
puth ( can_tx2_q . r_ptr ) ; puts ( " " ) ; puth ( can_tx2_q . w_ptr ) ; puts ( " \n " ) ;
# endif
// set green LED to be controls allowed
set_led ( LED_GREEN , controls_allowed ) ;
// blink the red LED
int div_mode = ( ( usb_power_mode = = USB_POWER_DCP ) ? 4 : 1 ) ;
for ( int div_mode_loop = 0 ; div_mode_loop < div_mode ; div_mode_loop + + ) {
for ( int fade = 0 ; fade < 1024 ; fade + = 8 ) {
for ( int i = 0 ; i < 128 / div_mode ; i + + ) {
set_led ( LED_RED , 0 ) ;
if ( fade < 512 ) { delay ( 512 - fade ) ; } else { delay ( fade - 512 ) ; }
set_led ( LED_RED , 1 ) ;
if ( fade < 512 ) { delay ( fade ) ; } else { delay ( 1024 - fade ) ; }
}
}
} else {
__WFI ( ) ;
}
// turn off the blue LED, turned on by CAN
# ifdef PANDA
set_led ( LED_BLUE , 0 ) ;
# endif
}
return 0 ;
}
Vehicle Researcher
6 years ago
