sergiotarxz/nuttx-apps
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

industry/foc/fixed16/foc_ident.c: add b16_t overflow protection

Browse Source
This commit is contained in:
raiden00pl 2022-08-27 17:59:12 +02:00 committed by Xiang Xiao
parent 4beb637925
commit 8609c92081
1 changed files with 20 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

20
industry/foc/fixed16/foc_ident.c
View File

@ -39,6 +39,7 @@
****************************************************************************/
#define IDENT_PI_KP (ftob16(0.0f))
#define B16UPPERLIMIT (0x7e000000)
/****************************************************************************
* Private Data Types
@ -211,6 +212,15 @@ int foc_ident_res_run_b16(FAR struct foc_ident_b16_s *ident,
ident->curr_sum += vector2d_mag_b16(in->foc_state->idq.q,
in->foc_state->idq.d);
}
/* Overflow protection */
if (ident->volt_sum > B16UPPERLIMIT || ident->curr_sum > B16UPPERLIMIT)
{
ret = -EOVERFLOW;
goto errout;
}
if (ident->cntr > ident->cfg.res_steps)
{
/* Get resistance */
@ -243,6 +253,7 @@ int foc_ident_res_run_b16(FAR struct foc_ident_b16_s *ident,
ident->volt_sum = 0;
}
errout:
return ret;
}
@ -289,6 +300,14 @@ int foc_ident_ind_run_b16(FAR struct foc_ident_b16_s *ident,
ident->curr2_sum += in->foc_state->idq.d;
}
/* Overflow protection */
if (ident->curr1_sum > B16UPPERLIMIT || ident->curr2_sum > B16UPPERLIMIT)
{
ret = -EOVERFLOW;
goto errout;
}
/* Invert voltage to generate square wave D voltage */
ident->sign = -ident->sign;
@ -357,6 +376,7 @@ int foc_ident_ind_run_b16(FAR struct foc_ident_b16_s *ident,
ident->curr2_sum = 0;
}
errout:
return ret;
}