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.
userTask.cpp@25:f3a6e7eec9c3, 2018-12-12 (annotated)
- Committer:
- MasashiNomura
- Date:
- Wed Dec 12 23:52:22 2018 +0000
- Revision:
- 25:f3a6e7eec9c3
- Parent:
- 24:c5945aaae777
- Child:
- 26:732bc37fbefd
2018/12/11
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| takeru0x1103 | 21:78302ecdb661 | 1 | //RTOS関連------------------ |
| takeru0x1103 | 1:15ab74f0d0f1 | 2 | #include "FreeRTOS.h" |
| takeru0x1103 | 1:15ab74f0d0f1 | 3 | #include "task.h" |
| takeru0x1103 | 21:78302ecdb661 | 4 | //#include "queue.h" |
| takeru0x1103 | 21:78302ecdb661 | 5 | //------------------RTOS関連 |
| takeru0x1103 | 21:78302ecdb661 | 6 | |
| takeru0x1103 | 17:f9610f3cfa1b | 7 | #include "globalFlags.h" |
| takeru0x1103 | 17:f9610f3cfa1b | 8 | #include "HbManager.h" |
| takeru0x1103 | 18:5aa48aec9cae | 9 | #include "hbCommand.h" |
| takeru0x1103 | 18:5aa48aec9cae | 10 | #include "uart.h" |
| MasashiNomura | 24:c5945aaae777 | 11 | #include "fpga.h" |
| takeru0x1103 | 1:15ab74f0d0f1 | 12 | |
| takeru0x1103 | 18:5aa48aec9cae | 13 | //タスクハンドル(停止とか再開に必要) |
| takeru0x1103 | 18:5aa48aec9cae | 14 | static xTaskHandle tskHandle[3]={NULL,}; |
| takeru0x1103 | 1:15ab74f0d0f1 | 15 | |
| takeru0x1103 | 21:78302ecdb661 | 16 | //------------------ |
| takeru0x1103 | 18:5aa48aec9cae | 17 | //タスク停止 |
| takeru0x1103 | 18:5aa48aec9cae | 18 | //------------------ |
| takeru0x1103 | 18:5aa48aec9cae | 19 | static void taskStop(int iId){ |
| takeru0x1103 | 18:5aa48aec9cae | 20 | sp.printf("Task[%d] Stop\r\n" , iId); |
| takeru0x1103 | 18:5aa48aec9cae | 21 | vTaskSuspend(tskHandle[iId]);//タスクを止める |
| takeru0x1103 | 18:5aa48aec9cae | 22 | } |
| takeru0x1103 | 18:5aa48aec9cae | 23 | |
| takeru0x1103 | 21:78302ecdb661 | 24 | //------------------ |
| takeru0x1103 | 18:5aa48aec9cae | 25 | //タスク再開 |
| takeru0x1103 | 18:5aa48aec9cae | 26 | //------------------ |
| takeru0x1103 | 18:5aa48aec9cae | 27 | static void taskStart(int iId){ |
| takeru0x1103 | 18:5aa48aec9cae | 28 | sp.printf("Task[%d] Start!!\r\n" , iId); |
| takeru0x1103 | 18:5aa48aec9cae | 29 | vTaskResume(tskHandle[iId]);//タスク再開 |
| takeru0x1103 | 18:5aa48aec9cae | 30 | } |
| takeru0x1103 | 18:5aa48aec9cae | 31 | |
| takeru0x1103 | 18:5aa48aec9cae | 32 | //======================================================== |
| takeru0x1103 | 21:78302ecdb661 | 33 | //コマンド解析タスク |
| takeru0x1103 | 21:78302ecdb661 | 34 | //======================================================== |
| takeru0x1103 | 21:78302ecdb661 | 35 | void taskCmdParser(void *pvParameters){ |
| takeru0x1103 | 21:78302ecdb661 | 36 | // int8_t *pcTaskName = (int8_t *) pvParameters;; |
| takeru0x1103 | 21:78302ecdb661 | 37 | portTickType xLastWakeTime = xTaskGetTickCount(); |
| takeru0x1103 | 21:78302ecdb661 | 38 | |
| takeru0x1103 | 21:78302ecdb661 | 39 | // vTaskDelay(300);//制御タスクを先に走らせたいので待たす |
| takeru0x1103 | 21:78302ecdb661 | 40 | |
| takeru0x1103 | 21:78302ecdb661 | 41 | while(1){ |
| takeru0x1103 | 21:78302ecdb661 | 42 | led2=!led2; |
| takeru0x1103 | 21:78302ecdb661 | 43 | //コマンド解釈 |
| takeru0x1103 | 21:78302ecdb661 | 44 | commandParse(); |
| takeru0x1103 | 21:78302ecdb661 | 45 | |
| takeru0x1103 | 21:78302ecdb661 | 46 | // |
| MasashiNomura | 24:c5945aaae777 | 47 | // if(gf_Armed){ |
| MasashiNomura | 24:c5945aaae777 | 48 | // setState(WAKEUP); |
| MasashiNomura | 24:c5945aaae777 | 49 | // gf_Armed = false; |
| MasashiNomura | 24:c5945aaae777 | 50 | // // taskStop(0);//制御タスクを止める |
| MasashiNomura | 24:c5945aaae777 | 51 | // // taskStart(2);//デバッグタスク再開 |
| MasashiNomura | 24:c5945aaae777 | 52 | // } |
| MasashiNomura | 22:24c9c2dedca9 | 53 | // else{ |
| MasashiNomura | 22:24c9c2dedca9 | 54 | // taskStop(2);//デバッグタスクを止める |
| MasashiNomura | 22:24c9c2dedca9 | 55 | // taskStart(0);//制御タスク再開 |
| MasashiNomura | 22:24c9c2dedca9 | 56 | // }//switch |
| takeru0x1103 | 21:78302ecdb661 | 57 | |
| takeru0x1103 | 21:78302ecdb661 | 58 | //次の周期まで待つ |
| takeru0x1103 | 21:78302ecdb661 | 59 | vTaskDelayUntil(&xLastWakeTime, 50 / portTICK_RATE_MS ); |
| takeru0x1103 | 21:78302ecdb661 | 60 | } |
| takeru0x1103 | 21:78302ecdb661 | 61 | } |
| takeru0x1103 | 21:78302ecdb661 | 62 | //======================================================== |
| takeru0x1103 | 17:f9610f3cfa1b | 63 | //ホバーバイク制御タスク |
| takeru0x1103 | 18:5aa48aec9cae | 64 | //======================================================== |
| takeru0x1103 | 17:f9610f3cfa1b | 65 | void taskHbControl(void *pvParameters){ |
| takeru0x1103 | 21:78302ecdb661 | 66 | // int8_t *pcTaskName = (int8_t *) pvParameters;; |
| takeru0x1103 | 21:78302ecdb661 | 67 | portTickType xLastWakeTime = xTaskGetTickCount(); |
| takeru0x1103 | 21:78302ecdb661 | 68 | |
| takeru0x1103 | 17:f9610f3cfa1b | 69 | HbManager hb; |
| takeru0x1103 | 8:1ca49cb18290 | 70 | |
| MasashiNomura | 23:79e20be4bc5b | 71 | bool bDoCtrlAtt; |
| MasashiNomura | 23:79e20be4bc5b | 72 | bool bDoCtrlMot; |
| takeru0x1103 | 18:5aa48aec9cae | 73 | // |
| takeru0x1103 | 1:15ab74f0d0f1 | 74 | while(1){ |
| takeru0x1103 | 16:05b9e44889f1 | 75 | led1=!led1; |
| MasashiNomura | 23:79e20be4bc5b | 76 | bDoCtrlAtt = false; |
| MasashiNomura | 23:79e20be4bc5b | 77 | bDoCtrlMot = false; |
| MasashiNomura | 24:c5945aaae777 | 78 | |
| MasashiNomura | 24:c5945aaae777 | 79 | // PID係数アップデートチェック |
| MasashiNomura | 24:c5945aaae777 | 80 | if(gf_PidParaUpdate){ |
| MasashiNomura | 24:c5945aaae777 | 81 | hb.setAttPara(g_PidPara); |
| MasashiNomura | 24:c5945aaae777 | 82 | sp.printf("Pp : [%f]\r\n",g_PidPara.PP); |
| MasashiNomura | 24:c5945aaae777 | 83 | sp.printf("P : [%f]\r\n",g_PidPara.P); |
| MasashiNomura | 24:c5945aaae777 | 84 | sp.printf("I : [%f]\r\n",g_PidPara.I); |
| MasashiNomura | 24:c5945aaae777 | 85 | sp.printf("D : [%f]\r\n",g_PidPara.D); |
| MasashiNomura | 24:c5945aaae777 | 86 | sp.printf("IMAX: [%f]\r\n",g_PidPara.IMax); |
| MasashiNomura | 24:c5945aaae777 | 87 | sp.printf("IMIN: [%f]\r\n",g_PidPara.IMin); |
| MasashiNomura | 24:c5945aaae777 | 88 | gf_PidParaUpdate = false; |
| MasashiNomura | 24:c5945aaae777 | 89 | } |
| MasashiNomura | 25:f3a6e7eec9c3 | 90 | for(int i = 0; i < 4; ++i){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 91 | if(gf_MotParaUpdate[i]){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 92 | hb.setMotPara((UCHAR)i, g_MotPara[i]); |
| MasashiNomura | 25:f3a6e7eec9c3 | 93 | sp.printf("num : [%d]\r\n",i); |
| MasashiNomura | 25:f3a6e7eec9c3 | 94 | //sp.printf("ofs : [%d]\r\n",g_MotPara[i].offset); |
| MasashiNomura | 25:f3a6e7eec9c3 | 95 | sp.printf("low : [%d]\r\n",g_MotPara[i].limit_low); |
| MasashiNomura | 25:f3a6e7eec9c3 | 96 | sp.printf("hi : [%d]\r\n",g_MotPara[i].limit_hi); |
| MasashiNomura | 25:f3a6e7eec9c3 | 97 | gf_MotParaUpdate[i] = false; |
| MasashiNomura | 25:f3a6e7eec9c3 | 98 | } |
| MasashiNomura | 25:f3a6e7eec9c3 | 99 | } |
| MasashiNomura | 25:f3a6e7eec9c3 | 100 | if(gf_StopMot){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 101 | setStateF(MOT_STOP); |
| MasashiNomura | 25:f3a6e7eec9c3 | 102 | hb.getCurMotVal(); |
| MasashiNomura | 25:f3a6e7eec9c3 | 103 | gf_StopMot = false; |
| MasashiNomura | 25:f3a6e7eec9c3 | 104 | } |
| MasashiNomura | 23:79e20be4bc5b | 105 | |
| takeru0x1103 | 21:78302ecdb661 | 106 | //▼①状態読み出し系 |
| MasashiNomura | 22:24c9c2dedca9 | 107 | hb.getAttitude(); //現在角度読み出し |
| MasashiNomura | 22:24c9c2dedca9 | 108 | hb.controlEngine(); //エンジン回転数読み出し |
| MasashiNomura | 22:24c9c2dedca9 | 109 | hb.getUserCommand(); //操作ボタン状態読み出し |
| takeru0x1103 | 18:5aa48aec9cae | 110 | |
| takeru0x1103 | 21:78302ecdb661 | 111 | //▼②ステート遷移 |
| MasashiNomura | 22:24c9c2dedca9 | 112 | switch(gf_State){ |
| MasashiNomura | 22:24c9c2dedca9 | 113 | case SLEEP: |
| MasashiNomura | 22:24c9c2dedca9 | 114 | if(gf_Dbg){ |
| MasashiNomura | 24:c5945aaae777 | 115 | gf_Dbg = false; |
| MasashiNomura | 22:24c9c2dedca9 | 116 | taskStart(2); |
| MasashiNomura | 22:24c9c2dedca9 | 117 | } |
| MasashiNomura | 23:79e20be4bc5b | 118 | else if(gf_Armed){ |
| MasashiNomura | 24:c5945aaae777 | 119 | gf_Armed = false; |
| MasashiNomura | 24:c5945aaae777 | 120 | // hb.initChkMotor(); |
| MasashiNomura | 23:79e20be4bc5b | 121 | setState(WAKEUP); |
| MasashiNomura | 23:79e20be4bc5b | 122 | } |
| MasashiNomura | 22:24c9c2dedca9 | 123 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 124 | case WAKEUP: |
| MasashiNomura | 24:c5945aaae777 | 125 | //各種モーター |
| MasashiNomura | 24:c5945aaae777 | 126 | //機材のチェック |
| MasashiNomura | 24:c5945aaae777 | 127 | // if(hb.chkMotor() == true){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 128 | hb.calAtt(); |
| MasashiNomura | 25:f3a6e7eec9c3 | 129 | // STANDBYでモーター回転をオフセット値まで上げるためのフラグセット |
| MasashiNomura | 25:f3a6e7eec9c3 | 130 | //for(int i = 0; i < 4; ++i){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 131 | // gf_MtReq[i].bf.req = true; |
| MasashiNomura | 25:f3a6e7eec9c3 | 132 | // gf_MtReq[i].bf.val = 200; |
| MasashiNomura | 25:f3a6e7eec9c3 | 133 | //} |
| MasashiNomura | 23:79e20be4bc5b | 134 | setState(STANDBY); |
| MasashiNomura | 24:c5945aaae777 | 135 | // } |
| MasashiNomura | 22:24c9c2dedca9 | 136 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 137 | case STANDBY: |
| MasashiNomura | 25:f3a6e7eec9c3 | 138 | // モーター回転数のチェック→モーターの回転数をオフセット値まで上げる |
| MasashiNomura | 25:f3a6e7eec9c3 | 139 | //nxtStatFlg = true; |
| MasashiNomura | 25:f3a6e7eec9c3 | 140 | //for(int i = 0; i < 4; ++i){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 141 | // if(gf_MtReq[i].bf.req){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 142 | // bDoCtrlMot = true; |
| MasashiNomura | 25:f3a6e7eec9c3 | 143 | // } |
| MasashiNomura | 25:f3a6e7eec9c3 | 144 | //} |
| MasashiNomura | 25:f3a6e7eec9c3 | 145 | if(!bDoCtrlMot){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 146 | if(hb.chkInRangeIDLE()){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 147 | setState(IDLE); |
| MasashiNomura | 25:f3a6e7eec9c3 | 148 | } |
| MasashiNomura | 25:f3a6e7eec9c3 | 149 | else{ |
| MasashiNomura | 25:f3a6e7eec9c3 | 150 | // デバッグのためここもスルー |
| MasashiNomura | 25:f3a6e7eec9c3 | 151 | setState(IDLE); |
| MasashiNomura | 25:f3a6e7eec9c3 | 152 | } |
| MasashiNomura | 23:79e20be4bc5b | 153 | } |
| MasashiNomura | 22:24c9c2dedca9 | 154 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 155 | case IDLE: |
| MasashiNomura | 23:79e20be4bc5b | 156 | //SWのチェック |
| MasashiNomura | 23:79e20be4bc5b | 157 | //離陸ボタン押下 |
| MasashiNomura | 23:79e20be4bc5b | 158 | //とりあえず、YawCtrlで代用 |
| MasashiNomura | 23:79e20be4bc5b | 159 | if(hb.chkSWUserOpe(HbUserOpe::YAW_CTRL)) |
| MasashiNomura | 23:79e20be4bc5b | 160 | { |
| MasashiNomura | 23:79e20be4bc5b | 161 | // TODO IMU Cal |
| MasashiNomura | 25:f3a6e7eec9c3 | 162 | hb.calAtt(); |
| MasashiNomura | 23:79e20be4bc5b | 163 | setState(TAKE_OFF); |
| MasashiNomura | 23:79e20be4bc5b | 164 | } |
| MasashiNomura | 23:79e20be4bc5b | 165 | //else if(hb.chkSWUserOpe(HbUserOpe::ENG_STOP)) |
| MasashiNomura | 23:79e20be4bc5b | 166 | //{ |
| MasashiNomura | 23:79e20be4bc5b | 167 | // setState(SLEEP); |
| MasashiNomura | 23:79e20be4bc5b | 168 | //} |
| MasashiNomura | 25:f3a6e7eec9c3 | 169 | if(hb.chkSWUserOpeAny()){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 170 | sp.printf("SW :[%X]\r\n",hb.getUserSw()); |
| MasashiNomura | 25:f3a6e7eec9c3 | 171 | } |
| MasashiNomura | 25:f3a6e7eec9c3 | 172 | bDoCtrlMot = true; |
| MasashiNomura | 22:24c9c2dedca9 | 173 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 174 | case TAKE_OFF: |
| MasashiNomura | 23:79e20be4bc5b | 175 | // エンジン回転数のチェック |
| MasashiNomura | 23:79e20be4bc5b | 176 | // 着陸ボタンが優先度が高いので先に判定、たが、まだ作ってないのでコメントアウト |
| MasashiNomura | 23:79e20be4bc5b | 177 | // if(hb.chkSWUserOpe(HbUserOpe::STOP)){ |
| MasashiNomura | 23:79e20be4bc5b | 178 | // setState(GROUND); |
| MasashiNomura | 23:79e20be4bc5b | 179 | // } |
| MasashiNomura | 23:79e20be4bc5b | 180 | //else |
| MasashiNomura | 23:79e20be4bc5b | 181 | bDoCtrlMot = true; |
| MasashiNomura | 23:79e20be4bc5b | 182 | bDoCtrlAtt = true; |
| MasashiNomura | 23:79e20be4bc5b | 183 | //if(hb.chkSWUserOpe(HbUserOpe::STOP)){ |
| MasashiNomura | 23:79e20be4bc5b | 184 | // setState(HOVER); |
| MasashiNomura | 23:79e20be4bc5b | 185 | //} |
| MasashiNomura | 23:79e20be4bc5b | 186 | |
| MasashiNomura | 22:24c9c2dedca9 | 187 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 188 | case GROUND: |
| MasashiNomura | 23:79e20be4bc5b | 189 | // そのままスルー |
| MasashiNomura | 23:79e20be4bc5b | 190 | setState(IDLE); |
| MasashiNomura | 22:24c9c2dedca9 | 191 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 192 | case HOVER: |
| MasashiNomura | 23:79e20be4bc5b | 193 | // |
| MasashiNomura | 22:24c9c2dedca9 | 194 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 195 | case DRIVE: |
| MasashiNomura | 22:24c9c2dedca9 | 196 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 197 | case EMGGND: |
| MasashiNomura | 22:24c9c2dedca9 | 198 | break; |
| MasashiNomura | 23:79e20be4bc5b | 199 | case CHK_ENT: //チェックエンター |
| MasashiNomura | 23:79e20be4bc5b | 200 | sp.printf("Check enter\r\n"); |
| MasashiNomura | 23:79e20be4bc5b | 201 | break; |
| MasashiNomura | 23:79e20be4bc5b | 202 | case CHK_MOT: //モーターチェック |
| MasashiNomura | 23:79e20be4bc5b | 203 | sp.printf("Check Motor\r\n"); |
| MasashiNomura | 23:79e20be4bc5b | 204 | bDoCtrlMot = true; |
| MasashiNomura | 23:79e20be4bc5b | 205 | break; |
| MasashiNomura | 23:79e20be4bc5b | 206 | case CHK_AXL: //アクセルサーボチェック |
| MasashiNomura | 23:79e20be4bc5b | 207 | sp.printf("Check Accel Servo\r\n"); |
| MasashiNomura | 23:79e20be4bc5b | 208 | break; |
| MasashiNomura | 23:79e20be4bc5b | 209 | case CHK_ATT: //姿勢制御チェック |
| MasashiNomura | 23:79e20be4bc5b | 210 | sp.printf("Check Attitude\r\n"); |
| MasashiNomura | 23:79e20be4bc5b | 211 | bDoCtrlAtt = true; |
| MasashiNomura | 23:79e20be4bc5b | 212 | break; |
| MasashiNomura | 23:79e20be4bc5b | 213 | case CHK_EXIT: //チェックステート脱出 |
| MasashiNomura | 23:79e20be4bc5b | 214 | sp.printf("Check Exit\r\n"); |
| MasashiNomura | 23:79e20be4bc5b | 215 | break; |
| MasashiNomura | 25:f3a6e7eec9c3 | 216 | case MOT_STOP: |
| MasashiNomura | 25:f3a6e7eec9c3 | 217 | if(hb.stopMotor() == true){ |
| MasashiNomura | 25:f3a6e7eec9c3 | 218 | hb.initMotVal(); |
| MasashiNomura | 25:f3a6e7eec9c3 | 219 | setState(SLEEP); |
| MasashiNomura | 25:f3a6e7eec9c3 | 220 | sp.printf("MOTOR STOPPED!\r\n"); |
| MasashiNomura | 25:f3a6e7eec9c3 | 221 | } |
| MasashiNomura | 25:f3a6e7eec9c3 | 222 | else{ |
| MasashiNomura | 25:f3a6e7eec9c3 | 223 | //bDoCtrlMot = true; |
| MasashiNomura | 25:f3a6e7eec9c3 | 224 | sp.printf("."); |
| MasashiNomura | 25:f3a6e7eec9c3 | 225 | } |
| MasashiNomura | 25:f3a6e7eec9c3 | 226 | break; |
| MasashiNomura | 22:24c9c2dedca9 | 227 | } |
| takeru0x1103 | 21:78302ecdb661 | 228 | |
| takeru0x1103 | 21:78302ecdb661 | 229 | //▼③各種設定 |
| takeru0x1103 | 21:78302ecdb661 | 230 | //hb.controlAttitude(); //姿勢制御 |
| takeru0x1103 | 21:78302ecdb661 | 231 | //hb.controlMotor();//モーター指令出し |
| MasashiNomura | 23:79e20be4bc5b | 232 | if(bDoCtrlAtt)hb.controlAttitude(); //姿勢制御 |
| MasashiNomura | 23:79e20be4bc5b | 233 | if(bDoCtrlMot)hb.controlMotor();//モーター指令出し |
| takeru0x1103 | 18:5aa48aec9cae | 234 | |
| MasashiNomura | 23:79e20be4bc5b | 235 | if(gf_Print.bf.stat){ |
| MasashiNomura | 23:79e20be4bc5b | 236 | sp.printf("stat : [%X]\r\n",gf_State); |
| MasashiNomura | 23:79e20be4bc5b | 237 | } |
| takeru0x1103 | 18:5aa48aec9cae | 238 | //表示フラグを落とす(けどモニタフラグが立ってる箇所は残る) |
| takeru0x1103 | 18:5aa48aec9cae | 239 | if(gf_Print.flg!=0){ |
| takeru0x1103 | 18:5aa48aec9cae | 240 | gf_Print.flg=gf_Mon.flg; |
| takeru0x1103 | 18:5aa48aec9cae | 241 | sp.printf("\r\n"); |
| takeru0x1103 | 18:5aa48aec9cae | 242 | } |
| takeru0x1103 | 1:15ab74f0d0f1 | 243 | |
| takeru0x1103 | 1:15ab74f0d0f1 | 244 | //次の周期まで待つ |
| takeru0x1103 | 1:15ab74f0d0f1 | 245 | vTaskDelayUntil(&xLastWakeTime, 20 / portTICK_RATE_MS ); |
| takeru0x1103 | 1:15ab74f0d0f1 | 246 | } |
| takeru0x1103 | 1:15ab74f0d0f1 | 247 | } |
| takeru0x1103 | 18:5aa48aec9cae | 248 | //======================================================== |
| takeru0x1103 | 21:78302ecdb661 | 249 | //タスク2:デバッグ用タスク |
| takeru0x1103 | 18:5aa48aec9cae | 250 | //======================================================== |
| takeru0x1103 | 18:5aa48aec9cae | 251 | void taskDebug(void *pvParameters){ |
| takeru0x1103 | 21:78302ecdb661 | 252 | |
| takeru0x1103 | 21:78302ecdb661 | 253 | taskStop(2);//自ら止めてレジュームされるまで待つ |
| MasashiNomura | 24:c5945aaae777 | 254 | UCHAR Num; |
| MasashiNomura | 24:c5945aaae777 | 255 | INT16 iVal; |
| MasashiNomura | 25:f3a6e7eec9c3 | 256 | //bool rvFlg; |
| MasashiNomura | 24:c5945aaae777 | 257 | |
| takeru0x1103 | 21:78302ecdb661 | 258 | //この関数をリターンしてしまうと他のタスクも止まるのでwhileで回すこと! |
| takeru0x1103 | 18:5aa48aec9cae | 259 | while(1){ |
| MasashiNomura | 24:c5945aaae777 | 260 | for(Num = 0; Num < 8; ++Num){ |
| MasashiNomura | 24:c5945aaae777 | 261 | for(iVal = 50; iVal < 300; ++iVal){ |
| MasashiNomura | 24:c5945aaae777 | 262 | fpgaMotor(Num, iVal); |
| MasashiNomura | 25:f3a6e7eec9c3 | 263 | wait(0.002); |
| MasashiNomura | 24:c5945aaae777 | 264 | } |
| MasashiNomura | 24:c5945aaae777 | 265 | for(iVal = 300; iVal >= 50; --iVal){ |
| MasashiNomura | 24:c5945aaae777 | 266 | fpgaMotor(Num, iVal); |
| MasashiNomura | 25:f3a6e7eec9c3 | 267 | wait(0.002); |
| MasashiNomura | 24:c5945aaae777 | 268 | } |
| MasashiNomura | 24:c5945aaae777 | 269 | } |
| MasashiNomura | 23:79e20be4bc5b | 270 | //自タスク停止させて次の周期まで待つ |
| MasashiNomura | 22:24c9c2dedca9 | 271 | gf_Dbg = false; |
| MasashiNomura | 23:79e20be4bc5b | 272 | sp.printf("Do DebugTask!"); |
| takeru0x1103 | 18:5aa48aec9cae | 273 | taskStop(2); |
| takeru0x1103 | 18:5aa48aec9cae | 274 | } |
| takeru0x1103 | 18:5aa48aec9cae | 275 | } |
| takeru0x1103 | 17:f9610f3cfa1b | 276 | |
| takeru0x1103 | 1:15ab74f0d0f1 | 277 | //------------------------------------------------------------- |
| takeru0x1103 | 17:f9610f3cfa1b | 278 | //初期化:タスク登録 |
| takeru0x1103 | 1:15ab74f0d0f1 | 279 | //------------------------------------------------------------- |
| takeru0x1103 | 1:15ab74f0d0f1 | 280 | void taskInit(){ |
| takeru0x1103 | 21:78302ecdb661 | 281 | portBASE_TYPE TaskRtn;//タスククリエイトの結果を受け取る型 |
| takeru0x1103 | 18:5aa48aec9cae | 282 | |
| takeru0x1103 | 21:78302ecdb661 | 283 | //タスク0:コマンド解析タスク |
| MasashiNomura | 23:79e20be4bc5b | 284 | TaskRtn= xTaskCreate(taskCmdParser, (signed portCHAR *)"TaskCmd", 256, NULL, 1, &tskHandle[0]); |
| takeru0x1103 | 21:78302ecdb661 | 285 | if(TaskRtn==pdTRUE){sp.printf("Task0 Set : Command parser\r\n");} |
| takeru0x1103 | 21:78302ecdb661 | 286 | |
| takeru0x1103 | 21:78302ecdb661 | 287 | //タスク1:制御タスク |
| MasashiNomura | 25:f3a6e7eec9c3 | 288 | TaskRtn= xTaskCreate(taskHbControl, (signed portCHAR *)"TaskHbCont", 512, NULL, 2, &tskHandle[1]); |
| takeru0x1103 | 21:78302ecdb661 | 289 | if(TaskRtn==pdTRUE){sp.printf("Task1 Set : Hoverbike Control\r\n");} |
| takeru0x1103 | 21:78302ecdb661 | 290 | |
| takeru0x1103 | 21:78302ecdb661 | 291 | //タスク2:デバッグタスク |
| MasashiNomura | 23:79e20be4bc5b | 292 | TaskRtn= xTaskCreate(taskDebug, (signed portCHAR *)"TaskDebug", 192, NULL, 0, &tskHandle[2]); |
| takeru0x1103 | 21:78302ecdb661 | 293 | if(TaskRtn==pdTRUE){sp.printf("Task2 Set : Debug\r\n");} |
| takeru0x1103 | 8:1ca49cb18290 | 294 | |
| takeru0x1103 | 21:78302ecdb661 | 295 | //RTOSカーネル起動(タスクが走り出す) |
| takeru0x1103 | 1:15ab74f0d0f1 | 296 | vTaskStartScheduler(); |
| takeru0x1103 | 1:15ab74f0d0f1 | 297 | } |
| takeru0x1103 | 1:15ab74f0d0f1 | 298 | |
| takeru0x1103 | 1:15ab74f0d0f1 | 299 |