uuu
Dependencies: mbed TrapezoidControl QEI Pulse LM61CIZ
Revision 24:370616a56815, committed 2019-09-18
- Comitter:
- M_souta
- Date:
- Wed Sep 18 02:03:56 2019 +0000
- Parent:
- 23:c853372cf626
- Commit message:
- ii
Changed in this revision
| System/Process/Process.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- a/System/Process/Process.cpp Wed Sep 18 01:58:57 2019 +0000
+++ b/System/Process/Process.cpp Wed Sep 18 02:03:56 2019 +0000
@@ -780,64 +780,7 @@
#if USE_PROCESS_NUM>7
static void Process7()
{
- if(lineFase == 0) { // 前進
- switch(linePara[0]) {
- case -2: adj_F = 10;
- break;
- case -3: adj_F = 5;
- break;
- case -1: adj_F = 2;
- break;
- case 0: adj_F = 0;
- break;
- case 1: adj_F = -2;
- break;
- case 3: adj_F = -5;
- break;
- case 2: adj_F = -10;
- break;
- case 'A':
- break;
- case 'N':
- break;
- default:
- }
- switch(linePara[2]) {
- case -2: adj_F = -10;
- break;
- case -3: adj_F = -5;
- break;
- case -1: adj_F = -2;
- break;
- case 0: adj_F = 0;
- break;
- case 1: adj_F = 2;
- break;
- case 3: adj_F = 5;
- break;
- case 2: adj_F = 10;
- break;
- case 'A': adj_F = 0;
- break;
- case 'N':
- break;
- default:
- }
-
- if(mode == 0) linePWM = 40;
- else if (mode == 1) linePWM = 20;
- else if (mode == 2) linePWM = 0;
- else linePWM = 0;
-
- motor[TIRE_FL].dir = SetStatus(linePWM - adj_F);
- motor[TIRE_BL].dir = SetStatus(linePWM - adj_B);
- motor[TIRE_BR].dir = SetStatus(-linePWM - adj_B);
- motor[TIRE_FR].dir = SetStatus(-linePWM - adj_F);
- motor[TIRE_FR].pwm = SetPWM(linePWM - adj_F);
- motor[TIRE_FL].pwm = SetPWM(linePWM - adj_B);
- motor[TIRE_BR].pwm = SetPWM(-linePWM - adj_B);
- motor[TIRE_BL].pwm = SetPWM(-linePWM - adj_F);
- }
+
}
#endif