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_RESOLVER_LOS,
FAULT_CODE_FLASH_CORRUPTION_APP_CFG, FAULT_CODE_FLASH_CORRUPTION_APP_CFG,
FAULT_CODE_FLASH_CORRUPTION_MC_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; } mc_fault_code;
typedef enum { typedef enum {

12
encoder.c
View File

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