MC100/Applications/foc/motor/motor.h

#ifndef _MOTOR_H__
#define _MOTOR_H__
#include "os/os_types.h"
#include "foc/core/controller.h"
#include "foc/motor/hall.h"
#include "foc/motor/encoder.h"
#include "foc/mc_config.h"
#include "foc/foc_config.h"

#define IDC_USER_LIMIT_NONE ((s16)0x3fff)
#define RPM_USER_LIMIT_NONE ((s16)0x3fff)

#define TURBO_GEAR 3
#define TURBO_GEAR_AUTO_EXIT_TIME 0//30*1000 //30S
#define TURBO_MIN_MOTOR_TEMP 90
#define TURBO_MIN_MOS_TEMP 80
typedef struct {
	bool running;
	u32  start_ts;
	u32  det_ts;
	u32  rpm;
	bool error;
}fan_t;

typedef struct {
	s16 idc_lim;
	s16 rpm_lim;
	u8  ebrk_lvl;
	u8  n_brkShutPower;
	u8  b_tcs;
}user_rt_set;

typedef struct {
	bool   	b_start;
	float  throttle;
	bool   b_ignor_throttle;
	bool   b_ind_start;
	bool   b_calibrate;
	bool   b_force_run;
	bool   b_runStall; //是否堵转
	bool   b_lock_motor;
	bool   b_auto_hold;
	bool   b_break;
	bool   b_epm;
	bool   b_cruise;
	u32    cruise_time;
	float  		cruise_torque;
	epm_dir_t 	epm_dir;
	bool   		b_epm_cmd_move;
	float  		f_epm_vel;
	float  		f_epm_trq;
	u32    		runStall_time;
	float  		runStall_pos;
	u8     		u_throttle_ration;
	s8     		s_direction;
	u32    		n_brake_errors;
	u32    		n_CritiCalErrMask;
	u8     		mode;
	bool   		b_high_vol_mode;
	u8     		n_gear;
	bool   		b_limit_pending;
	gear_t 		*gear_cfg;
	u32    		n_autohold_time;
	bool   		b_wait_brk_release;
	u8     		mos_lim;
	u8     		motor_lim;
	s16    		s_vbus_hw_min;
	s16    		s_vbus_hw_max;
	u16    		vbus_le_cnt;
    u16    		vbus_he_cnt;
	s16    		s_target_speed;
	s16    		s_force_torque;
	u8     		gear_last;
	u32    		turbo_time;
	u8 	   		turbo_remain_sec;
	mot_contrl_t controller;
	user_rt_set  u_set; //用户运行时设置
	fan_t  		fan[2];
	s16 		if_acc;
	s16			if_max_vel;
	s16			if_iq_set;
	float		force_open_angle;
	s32			force_open_wait;
	//for debug
	int foc_stop_cnt;
	int foc_start_cnt;
}motor_t;

extern motor_t motor;
motor_t * get_motor(void);
void mc_init(void);
bool mc_start(u8 mode);
bool mc_stop(void);
void mc_encoder_off_calibrate(s16 vd);
bool mc_throttle_released(void);
bool mc_lock_motor(bool lock);
bool mc_auto_hold(bool hold);
void mc_set_throttle_r(bool use, u8 r);
void mc_use_throttle(void);
bool mc_current_sensor_calibrate(float current);
bool mc_encoder_zero_calibrate(s16 vd);
bool mc_set_ctrl_mode(u8 mode);
bool mc_is_epm(void);
bool mc_start_epm(bool epm);
bool mc_start_epm_move(epm_dir_t dir, bool is_command);
void mc_get_running_status(u8 *data);
bool mc_command_epm_move(epm_dir_t dir);
bool mc_throttle_epm_move(epm_dir_t dir);
bool mc_is_start(void);
bool mc_set_gear(u8 gear);
u8 mc_get_gear(void);
u8 mc_get_internal_gear(void);
bool mc_set_critical_error(u8 err);
void mc_clr_critical_error(u8 err);
u32 mc_get_critical_error(void);
void mc_set_fan_duty(u8 duty);
void mc_force_run_open(s16 vd, s16 vq, bool align);
u16 mc_get_running_status2(void);
bool mc_enable_cruise(bool enable);
bool mc_is_cruise_enabled(void);
bool mc_set_cruise_speed(bool rpm_abs, float target_rpm);
void mc_set_idc_limit(s16 limit);
void mc_set_rpm_limit(s16 limit);
gear_t *mc_gear_conf(void);
gear_t *mc_gear_conf_by_gear(u8 n_gear);
void mc_set_motor_lim_level(u8 l);
void mc_set_mos_lim_level(u8 l);
void motor_debug(void);
int mc_get_phase_errinfo_block(u8 *data, int dlen);
bool mc_set_ebrk_level(u8 level);
s16 mc_get_ebrk_torque(void);
u16 mc_get_ebrk_time(void);
bool mc_critical_err_is_set(u8 err);
bool mc_hwbrk_can_shutpower(void);
void mc_start_current_rec(bool is_i, bool rec);
bool mc_ind_motor_start(bool start);
void mc_enable_brkshutpower(u8 shut);
void mc_enable_tcs(bool enable);
bool mc_set_target_vel(s16 vel);
float mc_gear_max_torque(s16 vel, u8 gear);
bool mc_set_force_torque(s16 torque);
bool mc_tcs_is_enabled(void);
float mc_get_max_torque_now(void);
bool mc_start_ifctl_mode(bool start, s16 accl, s16 max_vel, s16 align_vd, s16 iq_set);

static __INLINE mot_contrl_t *mot_contrl(void) {
	return &motor.controller;
}

static __INLINE foc_t *foc(void) {
	return &motor.controller.foc;
}

static __INLINE float motor_encoder_get_angle(void) {
#ifdef USE_ENCODER_HALL
	return hall_update_elec_angle();
#elif defined (USE_ENCODER_ABI)
	return encoder_get_theta(true);
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE u8 motor_encoder_may_error(void) {
#ifdef USE_ENCODER_HALL
	return false;
#elif defined (USE_ENCODER_ABI)
	return encoder_may_error();
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE void motor_encoder_update(bool detect_err) {
#ifdef USE_ENCODER_HALL
	hall_update_elec_angle();
#elif defined (USE_ENCODER_ABI)
	encoder_get_theta(detect_err);
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE float motor_encoder_get_speed(void) {
#ifdef USE_ENCODER_HALL
	return hall_get_velocity();
#elif defined (USE_ENCODER_ABI)
	return encoder_get_speed();
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE float motor_encoder_get_vel_count(void) {
#ifdef USE_ENCODER_HALL
	return hall_get_vel_counts();
#elif defined (USE_ENCODER_ABI)
	return encoder_get_vel_count();
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE float motor_encoder_get_position(void) {
#ifdef USE_ENCODER_HALL
	return hall_get_position();
#elif defined (USE_ENCODER_ABI)
	return encoder_get_position();
#else
	#error "Postion sensor ERROR"
#endif
}


static __INLINE void motor_encoder_init(void) {
#ifdef USE_ENCODER_HALL
	hall_init();
#elif defined (USE_ENCODER_ABI)
	encoder_init();
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE void motor_encoder_start(bool start) {
#ifdef USE_ENCODER_HALL
	hall_init();
#elif defined (USE_ENCODER_ABI)
	encoder_init_clear();
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE void motor_encoder_reinit(void) {
#ifdef USE_ENCODER_HALL
	hall_init();
#elif defined (USE_ENCODER_ABI)
	//do nothing
#else
	#error "Postion sensor ERROR"
#endif
}


static __INLINE float motor_encoder_zero_phase_detect(float *enc_off){
#ifdef USE_ENCODER_HALL
	return 0.0f;
#elif defined (USE_ENCODER_ABI)
	return encoder_zero_phase_detect(enc_off);
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE void motor_encoder_set_direction(s8 dir) {
#ifdef USE_ENCODER_HALL
	hall_set_direction(dir);
#elif defined (USE_ENCODER_ABI)
	//encoder_set_direction(dir);
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE void motor_encoder_lock_pos(bool lock) {
#ifdef USE_ENCODER_HALL
		
#elif defined (USE_ENCODER_ABI)
	encoder_lock_position(lock);
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE void motor_encoder_band_epm(bool epm) {
#ifdef USE_ENCODER_HALL
		
#elif defined (USE_ENCODER_ABI)
	encoder_epm_pll_band(epm);
#else
	#error "Postion sensor ERROR"
#endif
}

static __INLINE void motor_encoder_produce_error(bool error) {
#ifdef USE_ENCODER_HALL

#elif defined (USE_ENCODER_ABI)
	encoder_produce_error(error);
#else
	#error "Postion sensor ERROR"
#endif
}

#endif /* _MOTOR_H__ */