rusefi
/
bldc
mirror of https://github.com/rusefi/bldc.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

new faults

This commit is contained in:
Jakub Tomczak 2021-07-30 15:36:21 +02:00
parent 2511458ab3
commit 3ed1a8f632
2 changed files with 12 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
datatypes.h
View File

@ -148,7 +148,8 @@ typedef enum {
FAULT_CODE_RESOLVER_LOS,
FAULT_CODE_FLASH_CORRUPTION_APP_CFG,
FAULT_CODE_FLASH_CORRUPTION_MC_CFG,
FAULT_CODE_ENCODER_NO_MAGNET
FAULT_CODE_ENCODER_NO_MAGNET,
FAULT_CODE_ENCODER_MAGNET_TOO_STRONG
} mc_fault_code;
typedef enum {

12
encoder.c
View File

@ -721,15 +721,17 @@ uint8_t encoder_AS504x_verify_serial()
void encoder_AS504x_verify_magnet()
{
mc_fault_code current_fault = mc_interface_get_fault();
if(encoder_AS504x_get_diag().is_Comp_high)
{
mc_interface_fault_stop(FAULT_CODE_ENCODER_NO_MAGNET, 0, 1); // COMP HIGH
}
else if(encoder_AS504x_get_diag().is_Comp_low)
{
mc_interface_fault_stop(FAULT_CODE_ENCODER_NO_MAGNET, 0, 1); // COMP low
mc_interface_fault_stop(FAULT_CODE_ENCODER_MAGNET_TOO_STRONG, 0, 1); // COMP low
}
else if(FAULT_CODE_ENCODER_NO_MAGNET == mc_interface_get_fault())
else if(FAULT_CODE_ENCODER_NO_MAGNET == current_fault || FAULT_CODE_ENCODER_MAGNET_TOO_STRONG == current_fault)
{
mc_interface_fault_stop(FAULT_CODE_NONE, 0, 1);
}
@ -760,6 +762,7 @@ void encoder_AS504x_determinate_if_connected(AS504x_last_packet_status was_last_
AS504x_spi_communication_error_count = AS504x_CONNECTION_DETERMINATOR_ERROR_THRESHOLD;
encoder_AS504x_update_connected_diag(0);
mc_interface_fault_stop(FAULT_CODE_ENCODER_SPI, 0, 1);
}
}
else
@ -771,6 +774,11 @@ void encoder_AS504x_determinate_if_connected(AS504x_last_packet_status was_last_
else
{
encoder_AS504x_update_connected_diag(1);
if(FAULT_CODE_ENCODER_SPI == mc_interface_get_fault())
{
mc_interface_fault_stop(FAULT_CODE_NONE, 0, 1);
}
}
}
}