|
| 1 | + |
1 | 2 | #include "../hardware_api.h"
|
2 | 3 |
|
3 | 4 | #if defined(NRF52_SERIES)
|
4 | 5 |
|
| 6 | + |
5 | 7 | #define PWM_CLK (16000000)
|
6 | 8 | #define PWM_FREQ (40000)
|
7 | 9 | #define PWM_RESOLUTION (PWM_CLK/PWM_FREQ)
|
@@ -108,9 +110,9 @@ void _configure3PWM(long pwm_frequency,const int pinA, const int pinB, const int
|
108 | 110 |
|
109 | 111 | pwm_range = (PWM_CLK / pwm_frequency);
|
110 | 112 |
|
111 |
| - int pA = g_ADigitalPinMap[pinA]; |
112 |
| - int pB = g_ADigitalPinMap[pinB]; |
113 |
| - int pC = g_ADigitalPinMap[pinC]; |
| 113 | + int pA = digitalPinToPinName(pinA); //g_ADigitalPinMap[pinA]; |
| 114 | + int pB = digitalPinToPinName(pinB); //g_ADigitalPinMap[pinB]; |
| 115 | + int pC = digitalPinToPinName(pinC); //g_ADigitalPinMap[pinC]; |
114 | 116 |
|
115 | 117 | // determine which motor are we connecting
|
116 | 118 | // and set the appropriate configuration parameters
|
@@ -159,10 +161,10 @@ void _configure4PWM(long pwm_frequency,const int pinA, const int pinB, const int
|
159 | 161 |
|
160 | 162 | pwm_range = (PWM_CLK / pwm_frequency);
|
161 | 163 |
|
162 |
| - int pA = g_ADigitalPinMap[pinA]; |
163 |
| - int pB = g_ADigitalPinMap[pinB]; |
164 |
| - int pC = g_ADigitalPinMap[pinC]; |
165 |
| - int pD = g_ADigitalPinMap[pinD]; |
| 164 | + int pA = digitalPinToPinName(pinA); //g_ADigitalPinMap[pinA]; |
| 165 | + int pB = digitalPinToPinName(pinB); //g_ADigitalPinMap[pinB]; |
| 166 | + int pC = digitalPinToPinName(pinC); //g_ADigitalPinMap[pinC]; |
| 167 | + int pD = digitalPinToPinName(pinD); //g_ADigitalPinMap[pinD]; |
166 | 168 |
|
167 | 169 | // determine which motor are we connecting
|
168 | 170 | // and set the appropriate configuration parameters
|
@@ -261,12 +263,12 @@ int _configure6PWM(long pwm_frequency, float dead_zone, const int pinA_h, const
|
261 | 263 | dead_time = DEAD_TIME/2;
|
262 | 264 | }
|
263 | 265 |
|
264 |
| - int pA_l = g_ADigitalPinMap[pinA_l]; |
265 |
| - int pA_h = g_ADigitalPinMap[pinA_h]; |
266 |
| - int pB_l = g_ADigitalPinMap[pinB_l]; |
267 |
| - int pB_h = g_ADigitalPinMap[pinB_h]; |
268 |
| - int pC_l = g_ADigitalPinMap[pinC_l]; |
269 |
| - int pC_h = g_ADigitalPinMap[pinC_h]; |
| 266 | + int pA_l = digitalPinToPinName(pinA_l); //g_ADigitalPinMap[pinA_l]; |
| 267 | + int pA_h = digitalPinToPinName(pinA_h); //g_ADigitalPinMap[pinA_h]; |
| 268 | + int pB_l = digitalPinToPinName(pinB_l); //g_ADigitalPinMap[pinB_l]; |
| 269 | + int pB_h = digitalPinToPinName(pinB_h); //g_ADigitalPinMap[pinB_h]; |
| 270 | + int pC_l = digitalPinToPinName(pinC_l); //g_ADigitalPinMap[pinC_l]; |
| 271 | + int pC_h = digitalPinToPinName(pinC_h); //g_ADigitalPinMap[pinC_h]; |
270 | 272 |
|
271 | 273 |
|
272 | 274 | // determine which motor are we connecting
|
|
0 commit comments