串口init测试通过,其他模块待测试
This commit is contained in:
@@ -15,6 +15,9 @@
|
||||
/* %%%-SFUNWIZ_wrapper_includes_Changes_BEGIN --- EDIT HERE TO _END */
|
||||
#ifdef HAL_IMPL
|
||||
/* TODO include files */
|
||||
|
||||
#include "AppMagnetic.h"
|
||||
|
||||
#endif
|
||||
#include <stdint.h>
|
||||
/* %%%-SFUNWIZ_wrapper_includes_Changes_END --- EDIT HERE TO _BEGIN */
|
||||
@@ -40,6 +43,27 @@ void initialize_3axis_magn(uint8_t id)
|
||||
#endif
|
||||
}
|
||||
break;
|
||||
|
||||
case 1:
|
||||
if (!magn_inited[1])
|
||||
{
|
||||
#ifdef HAL_IMPL
|
||||
// TODO initialize 3axis-magn No.1
|
||||
magn_inited[1] = 1;
|
||||
#endif
|
||||
}
|
||||
break;
|
||||
|
||||
case 2:
|
||||
if (!magn_inited[2])
|
||||
{
|
||||
#ifdef HAL_IMPL
|
||||
// TODO initialize 3axis-magn No.2
|
||||
magn_inited[2] = 1;
|
||||
#endif
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
@@ -73,10 +97,39 @@ void hal_3axis_magn_Outputs_wrapper(HAL_magn_mG_t *magn,
|
||||
{
|
||||
#ifdef HAL_IMPL
|
||||
// TODO read 6axis-IMU
|
||||
ErrorCode[0] = 0;
|
||||
if(AppMagGetRawData(id[0], magn->x, magn->y, magn->z))
|
||||
ErrorCode[0] = 0;
|
||||
else
|
||||
ErrorCode[0] = -1;
|
||||
#endif
|
||||
}
|
||||
break;
|
||||
|
||||
case 1:
|
||||
if (magn_inited[1])
|
||||
{
|
||||
#ifdef HAL_IMPL
|
||||
// TODO read 6axis-IMU
|
||||
if(AppMagGetRawData(id[0], magn->x, magn->y, magn->z))
|
||||
ErrorCode[0] = 0;
|
||||
else
|
||||
ErrorCode[0] = -1;
|
||||
#endif
|
||||
}
|
||||
|
||||
case 2:
|
||||
if (magn_inited[2])
|
||||
{
|
||||
#ifdef HAL_IMPL
|
||||
// TODO read 6axis-IMU
|
||||
if(AppMagGetRawData(id[0], magn->x, magn->y, magn->z))
|
||||
ErrorCode[0] = 0;
|
||||
else
|
||||
ErrorCode[0] = -1;
|
||||
#endif
|
||||
}
|
||||
break;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user