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

examples/foc: add missing deinit calls

Browse Source
This commit is contained in:
raiden00pl 2022-11-04 19:01:44 +01:00 committed by Alan Carvalho de Assis
parent f358bdfcb3
commit caba5a0a6f
2 changed files with 68 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

35
examples/foc/foc_motor_b16.c
View File

@ -1046,6 +1046,39 @@ int foc_motor_deinit(FAR struct foc_motor_b16_s *motor)
DEBUGASSERT(motor); DEBUGASSERT(motor);
#ifdef CONFIG_EXAMPLES_FOC_HAVE_OPENLOOP
/* Deinitialzie open-loop handler */
ret = foc_angle_deinit_b16(&motor->openloop);
if (ret < 0)
{
PRINTFV("ERROR: foc_angle_deinit_b16 failed %d!\n", ret);
goto errout;
}
#endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_QENCO
/* Deinitialzie qenco handler */
ret = foc_angle_deinit_b16(&motor->qenco);
if (ret < 0)
{
PRINTFV("ERROR: foc_angle_deinit_b16 failed %d!\n", ret);
goto errout;
}
#endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_HALL
/* Deinitialzie hall handler */
ret = foc_angle_deinit_b16(&motor->hall);
if (ret < 0)
{
PRINTFV("ERROR: foc_angle_deinit_b16 failed %d!\n", ret);
goto errout;
}
#endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_ALIGN #ifdef CONFIG_EXAMPLES_FOC_HAVE_ALIGN
/* Deinitialize motor alignment routine */ /* Deinitialize motor alignment routine */
@ -1058,7 +1091,7 @@ int foc_motor_deinit(FAR struct foc_motor_b16_s *motor)
#endif #endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_IDENT #ifdef CONFIG_EXAMPLES_FOC_HAVE_IDENT
/* Deinitialize motor identment routine */ /* Deinitialize motor identification routine */
ret = foc_routine_deinit_b16(&motor->ident); ret = foc_routine_deinit_b16(&motor->ident);
if (ret < 0) if (ret < 0)

35
examples/foc/foc_motor_f32.c
View File

@ -1033,6 +1033,39 @@ int foc_motor_deinit(FAR struct foc_motor_f32_s *motor)
DEBUGASSERT(motor); DEBUGASSERT(motor);
#ifdef CONFIG_EXAMPLES_FOC_HAVE_OPENLOOP
/* Deinitialzie open-loop handler */
ret = foc_angle_deinit_f32(&motor->openloop);
if (ret < 0)
{
PRINTFV("ERROR: foc_angle_deinit_f32 failed %d!\n", ret);
goto errout;
}
#endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_QENCO
/* Deinitialzie qenco handler */
ret = foc_angle_deinit_f32(&motor->qenco);
if (ret < 0)
{
PRINTFV("ERROR: foc_angle_deinit_f32 failed %d!\n", ret);
goto errout;
}
#endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_HALL
/* Deinitialzie hall handler */
ret = foc_angle_deinit_f32(&motor->hall);
if (ret < 0)
{
PRINTFV("ERROR: foc_angle_deinit_f32 failed %d!\n", ret);
goto errout;
}
#endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_ALIGN #ifdef CONFIG_EXAMPLES_FOC_HAVE_ALIGN
/* Deinitialize motor alignment routine */ /* Deinitialize motor alignment routine */
@ -1045,7 +1078,7 @@ int foc_motor_deinit(FAR struct foc_motor_f32_s *motor)
#endif #endif
#ifdef CONFIG_EXAMPLES_FOC_HAVE_IDENT #ifdef CONFIG_EXAMPLES_FOC_HAVE_IDENT
/* Deinitialize motor identment routine */ /* Deinitialize motor identification routine */
ret = foc_routine_deinit_f32(&motor->ident); ret = foc_routine_deinit_f32(&motor->ident);
if (ret < 0) if (ret < 0)