change clock to HF
This commit is contained in:
@@ -19,11 +19,11 @@ float Lowpassfilter(float Tf, float x)
|
||||
uint32_t Timesamp = DL_SYSTICK_getValue();
|
||||
if(Timesamp < Last_Timesamp)
|
||||
{
|
||||
dt = (float)(Last_Timesamp - Timesamp) / 32 * 1e-6;
|
||||
dt = (float)(Last_Timesamp - Timesamp) / 80 * 1e-6;
|
||||
}
|
||||
else
|
||||
{
|
||||
dt = (float)(0xFFFFFF - Timesamp + Last_Timesamp) / 32 * 1e-6;
|
||||
dt = (float)(0xFFFFFF - Timesamp + Last_Timesamp) / 80 * 1e-6;
|
||||
}
|
||||
|
||||
if(dt < 0.0 || dt == 0)
|
||||
|
||||
@@ -19,11 +19,11 @@ float PID_Controller(float Kp, float Ki, float Kd, float Error)
|
||||
uint32_t Timestamp = DL_SYSTICK_getValue();
|
||||
if(Timestamp < Timestamp_Last)
|
||||
{
|
||||
Ts = (float)(Timestamp_Last - Timestamp) / 32 * 1e-6;
|
||||
Ts = (float)(Timestamp_Last - Timestamp) / 80 * 1e-6;
|
||||
}
|
||||
else
|
||||
{
|
||||
Ts = (0xFFFFFF - Timestamp + Timestamp_Last) / 32 * 1e-6;
|
||||
Ts = (0xFFFFFF - Timestamp + Timestamp_Last) / 80 * 1e-6;
|
||||
}
|
||||
|
||||
if(Ts <= 0 || Ts > 0.05f)
|
||||
|
||||
Reference in New Issue
Block a user