robot

Dependencies:   FastPWM3 mbed

config_loop.h

Committer:
bwang
Date:
2017-02-24
Revision:
74:f10cb573d7ca
Parent:
73:d44bc3a46942
Child:
75:591556ce033d

File content as of revision 74:f10cb573d7ca:

#ifndef __CONFIG_LOOP_H
#define __CONFIG_LOOP_H

#include "config_inverter.h"

#define K_LOOP_D 2.5f
#define KI_BASE_D 0.025f

#define K_LOOP_Q 6.0f
#define KI_BASE_Q 0.01f

#define F_SLOW_LOOP 1000.0f

#define INTEGRAL_MAX 1.0f

/*filter strengths, 0-1.0
  higher = stronger filtering*/
#define W_FILTER_STRENGTH 0.99f
#define DQ_FILTER_STRENGTH 0.95f
#define THROTTLE_FILTER_STRENGTH_LOW 0.99f
#define THROTTLE_FILTER_STRENGTH_HI 0.0f

/*reduce filtering past this point for performance reasons*/
#define THROTTLE_FILTER_THRESHOLD 0.25f

/*internally computed*/
#define KP_D (K_LOOP_D / BUS_VOLTAGE)
#define KI_D (KI_BASE_D * K_LOOP_D / BUS_VOLTAGE * 5000.0f / F_SW)

#define KP_Q (K_LOOP_Q / BUS_VOLTAGE)
#define KI_Q (KI_BASE_Q * K_LOOP_Q / BUS_VOLTAGE * 5000.0f / F_SW)

#define SLOW_LOOP_COUNTER ((int) (F_SW / F_SLOW_LOOP))

#endif