Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
HbManager.h@36:2cc739c7e4cb, 2019-01-16 (annotated)
- Committer:
- MasashiNomura
- Date:
- Wed Jan 16 10:51:07 2019 +0000
- Revision:
- 36:2cc739c7e4cb
- Parent:
- 33:eb260dbfc22a
- Child:
- 38:24ee50452755
2019/01/16 modify for 45inc Alfa HB / no debug, no checking
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
takeru0x1103 | 16:05b9e44889f1 | 1 | #ifndef __HBMANAGER_H__ |
takeru0x1103 | 16:05b9e44889f1 | 2 | #define __HBMANAGER_H__ |
takeru0x1103 | 0:ecd925601fc6 | 3 | ///////////////////////////////////////////////////////////////////// |
takeru0x1103 | 17:f9610f3cfa1b | 4 | #include "typedef.h" |
takeru0x1103 | 17:f9610f3cfa1b | 5 | #include "HbEngine.h" |
takeru0x1103 | 18:5aa48aec9cae | 6 | #include "HbAttitude.h" |
takeru0x1103 | 18:5aa48aec9cae | 7 | #include "HbMotor.h" |
takeru0x1103 | 18:5aa48aec9cae | 8 | #include "Imu.h" |
MasashiNomura | 22:24c9c2dedca9 | 9 | #include "HbUserOpe.h" |
takeru0x1103 | 17:f9610f3cfa1b | 10 | |
takeru0x1103 | 0:ecd925601fc6 | 11 | |
takeru0x1103 | 19:4b0fe9a5ec38 | 12 | |
takeru0x1103 | 19:4b0fe9a5ec38 | 13 | |
takeru0x1103 | 17:f9610f3cfa1b | 14 | ///////////////////////////////////////////////// |
takeru0x1103 | 17:f9610f3cfa1b | 15 | class HbManager{ |
takeru0x1103 | 17:f9610f3cfa1b | 16 | private: |
MasashiNomura | 36:2cc739c7e4cb | 17 | //INT16 motorVal[4] ;// |
takeru0x1103 | 18:5aa48aec9cae | 18 | UINT16 accelVal[2] ;// |
MasashiNomura | 36:2cc739c7e4cb | 19 | float nowTrgtAng; //目標ヨー角 |
takeru0x1103 | 19:4b0fe9a5ec38 | 20 | float nowAngle ;//現在ヨー角 |
takeru0x1103 | 19:4b0fe9a5ec38 | 21 | float nowRate ;//現在加速度 |
MasashiNomura | 22:24c9c2dedca9 | 22 | typUserSw usrSW ;//ユーザー操作SW |
takeru0x1103 | 19:4b0fe9a5ec38 | 23 | //メンバクラス |
takeru0x1103 | 18:5aa48aec9cae | 24 | HbEngine *eng[2] ;//エンジン制御クラス |
takeru0x1103 | 18:5aa48aec9cae | 25 | HbAttitude *att ;//姿勢制御クラス |
MasashiNomura | 28:fdb3b144e342 | 26 | //HbMotor *mot[4] ;//モーター制御クラス |
MasashiNomura | 28:fdb3b144e342 | 27 | HbSubProp *subProp[4] ;//モーター制御クラス |
takeru0x1103 | 18:5aa48aec9cae | 28 | Imu *imu ;//慣性計測装置 |
MasashiNomura | 22:24c9c2dedca9 | 29 | |
MasashiNomura | 22:24c9c2dedca9 | 30 | HbUserOpe *ope ;//ユーザー操作 |
MasashiNomura | 22:24c9c2dedca9 | 31 | |
MasashiNomura | 24:c5945aaae777 | 32 | //INT16 motVal; // モーターチェック用モーター値 |
MasashiNomura | 24:c5945aaae777 | 33 | //short motNum; // モーターチェック用モーター番号 |
MasashiNomura | 24:c5945aaae777 | 34 | |
takeru0x1103 | 17:f9610f3cfa1b | 35 | public: |
takeru0x1103 | 17:f9610f3cfa1b | 36 | HbManager(); |
takeru0x1103 | 18:5aa48aec9cae | 37 | void getAttitude(); |
MasashiNomura | 25:f3a6e7eec9c3 | 38 | void calAtt(); |
takeru0x1103 | 18:5aa48aec9cae | 39 | void controlAttitude(); |
MasashiNomura | 24:c5945aaae777 | 40 | void controlAttitude(float cmdAngle); |
MasashiNomura | 24:c5945aaae777 | 41 | void setAttPara(typPidPara para); |
takeru0x1103 | 18:5aa48aec9cae | 42 | void controlMotor(); |
MasashiNomura | 29:eb3d72dd94aa | 43 | void addMotVal(eMotPos pos, INT16 add); |
MasashiNomura | 29:eb3d72dd94aa | 44 | void subMotVal(eMotPos pos, INT16 add); |
MasashiNomura | 30:13ada1a24c59 | 45 | INT16 getCurMotVal(eMotPos pos); |
MasashiNomura | 30:13ada1a24c59 | 46 | void setMotVal(eMotPos pos, INT16 val); |
MasashiNomura | 27:ff63c23bc689 | 47 | |
MasashiNomura | 36:2cc739c7e4cb | 48 | //void setMotFPGA(UCHAR num, INT16 val); |
MasashiNomura | 27:ff63c23bc689 | 49 | |
takeru0x1103 | 17:f9610f3cfa1b | 50 | void controlEngine(); |
MasashiNomura | 36:2cc739c7e4cb | 51 | void clearHvAxl(); |
MasashiNomura | 36:2cc739c7e4cb | 52 | bool chkSetHvAxl(eEgPos pos); |
MasashiNomura | 36:2cc739c7e4cb | 53 | void setHvAxl(eEgPos pos, INT16 val); |
MasashiNomura | 36:2cc739c7e4cb | 54 | void setAccelVal(eEgPos pos, INT16 val); |
MasashiNomura | 36:2cc739c7e4cb | 55 | |
takeru0x1103 | 17:f9610f3cfa1b | 56 | void getUserCommand(); |
MasashiNomura | 33:eb260dbfc22a | 57 | INT16 getUserMotAxl(); |
MasashiNomura | 36:2cc739c7e4cb | 58 | INT16 getUserEngTrottle(); |
MasashiNomura | 33:eb260dbfc22a | 59 | |
MasashiNomura | 23:79e20be4bc5b | 60 | bool chkOverIDLE(); |
MasashiNomura | 23:79e20be4bc5b | 61 | bool chkInRangeIDLE(); |
MasashiNomura | 31:56c554c560c1 | 62 | void chkSW(enmHbState stat); |
MasashiNomura | 23:79e20be4bc5b | 63 | bool chkSWUserOpe(HbUserOpe::SW_TYPE stype); |
MasashiNomura | 30:13ada1a24c59 | 64 | bool chkSWUserOpeRE(HbUserOpe::SW_TYPE stype);//立ち上がり検出 |
MasashiNomura | 23:79e20be4bc5b | 65 | bool chkSWUserOpeAny(); |
MasashiNomura | 36:2cc739c7e4cb | 66 | bool chkSWUserOpeBoth(HbUserOpe::SW_TYPE stype1, HbUserOpe::SW_TYPE stype2); |
MasashiNomura | 36:2cc739c7e4cb | 67 | |
MasashiNomura | 23:79e20be4bc5b | 68 | typUserSw getUserSw(); |
takeru0x1103 | 17:f9610f3cfa1b | 69 | }; |
takeru0x1103 | 0:ecd925601fc6 | 70 | |
takeru0x1103 | 0:ecd925601fc6 | 71 | ///////////////////////////////////////////////////////////////////// |
takeru0x1103 | 16:05b9e44889f1 | 72 | #endif |