robot

Dependencies:   FastPWM3 mbed

DQMapper/DQMapper.h

Committer:
bwang
Date:
2017-05-04
Revision:
155:7c6005933d4c
Parent:
124:e70ca81676fc
Child:
160:6948bb7bcabd

File content as of revision 155:7c6005933d4c:

#ifndef __DQ_MAPPER_H
#define __DQ_MAPPER_H

class DQMapper {
public:
    virtual void map(float torque_percent, float w, float *d, float *q) = 0;
};

class QOnlyMapper : public DQMapper {
public:
    QOnlyMapper(float kt, float tmax) {_kt = kt; _tmax = tmax;}
    virtual void map(float torque_percent, float w, float *d, float *q) {*d = 0; *q = torque_percent * _tmax / _kt;}
private:
    float _kt;
    float _tmax;
};

class LinearNoFWMapper : public DQMapper {
public:
    LinearNoFWMapper(float kt, float tmax, float lambda) {_kt = kt; _tmax = tmax; _lambda = lambda;}
    virtual void map(float torque_percent, float w, float *d, float *q);
private:
    float _kt;
    float _tmax;
    float _lambda;
};

class LutMapper : public DQMapper {
public:
    virtual void map(float torque_percent, float w, float *d, float *q);
};

class AngleMapper : public DQMapper {
public:
    AngleMapper(float theta, float is) {_theta = theta; _is = is;}
    virtual void map(float torque_percent, float w, float *d, float *q);
private:
    float _is;
    float _theta;
};

class DirectMapper : public DQMapper {
public:
    DirectMapper(float id, float iq) {_id = id; _iq = iq;}
    virtual void map(float torque_percent, float w, float *d, float *q);
private:
    float _id, _iq;
};

class SwapMapper : public DQMapper {
public:
    SwapMapper(float id, float iq) {_id = id; _iq = iq;}
    virtual void map(float torque_percent, float w, float *d, float *q);
private:
    float _id, _iq;
};

#endif