Compare commits
4
Commits
6a6a1589ee
..
config
| Author | SHA1 | Date | |
|---|---|---|---|
|
|
e67abc6889 | ||
|
|
8071f4c246 | ||
|
|
65502c60f0 | ||
|
|
f746a3fc2d |
No files matched your search
@@ -5,7 +5,7 @@
|
|||||||
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1232117135261576401" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1781085212299121332" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
||||||
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
||||||
<language-scope id="org.eclipse.cdt.core.g++"/>
|
<language-scope id="org.eclipse.cdt.core.g++"/>
|
||||||
</provider>
|
</provider>
|
||||||
@@ -16,7 +16,7 @@
|
|||||||
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1232117135261576401" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1781085212299121332" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
||||||
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
||||||
<language-scope id="org.eclipse.cdt.core.g++"/>
|
<language-scope id="org.eclipse.cdt.core.g++"/>
|
||||||
</provider>
|
</provider>
|
||||||
|
|||||||
@@ -5,7 +5,7 @@
|
|||||||
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1170989325916314487" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1842213021644383246" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
||||||
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
||||||
<language-scope id="org.eclipse.cdt.core.g++"/>
|
<language-scope id="org.eclipse.cdt.core.g++"/>
|
||||||
</provider>
|
</provider>
|
||||||
@@ -16,7 +16,7 @@
|
|||||||
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.ui.UserLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.core.ReferencedProjectsLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
<provider-reference id="org.eclipse.cdt.managedbuilder.core.MBSLanguageSettingsProvider" ref="shared-provider"/>
|
||||||
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="1170989325916314487" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
<provider class="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" console="false" env-hash="-1842213021644383246" id="com.st.stm32cube.ide.mcu.toolchain.armnone.setup.CrossBuiltinSpecsDetector" keep-relative-paths="false" name="MCU ARM GCC Built-in Compiler Settings" parameter="${COMMAND} ${FLAGS} -E -P -v -dD "${INPUTS}"" prefer-non-shared="true">
|
||||||
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
<language-scope id="org.eclipse.cdt.core.gcc"/>
|
||||||
<language-scope id="org.eclipse.cdt.core.g++"/>
|
<language-scope id="org.eclipse.cdt.core.g++"/>
|
||||||
</provider>
|
</provider>
|
||||||
|
|||||||
@@ -4,8 +4,8 @@
|
|||||||
#include "semphr.h"
|
#include "semphr.h"
|
||||||
|
|
||||||
// TIM4 (Pulse an PD15) laeuft mit 200 MHz / 128, TIM1 zaehlt die Pulse (16 Bit)
|
// TIM4 (Pulse an PD15) laeuft mit 200 MHz / 128, TIM1 zaehlt die Pulse (16 Bit)
|
||||||
#define STEP_TICK_HZ 1562500u
|
#define STEP_TICK_HZ 1562500u //TIM4 Takt
|
||||||
#define STEP_CHUNK 60000u
|
#define STEP_CHUNK 60000u //TIM1 16 Bit:
|
||||||
#define STEP_HZ_MOVE 4000u // 300 mm/min bei 800 Schritten/mm
|
#define STEP_HZ_MOVE 4000u // 300 mm/min bei 800 Schritten/mm
|
||||||
#define STEP_HZ_REFERENCE 500u // 37,5 mm/min bei 800 Schritten/mm
|
#define STEP_HZ_REFERENCE 500u // 37,5 mm/min bei 800 Schritten/mm
|
||||||
#define STEP_POLL_MS 50u // Treiberstatus-Abfrage waehrend der Fahrt
|
#define STEP_POLL_MS 50u // Treiberstatus-Abfrage waehrend der Fahrt
|
||||||
@@ -23,9 +23,16 @@ static L6474_Handle_t stepperHandle = NULL;
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
int state = 0;
|
int state = 0;
|
||||||
|
float posmax = 295;
|
||||||
|
float posmin = 0.0f;
|
||||||
|
float posref = 0.0f;
|
||||||
|
int mmperturn = 1;
|
||||||
|
// eingestellter Step Mode: 1, 2, 4, 8 oder 16
|
||||||
|
int microsteps = 16;
|
||||||
|
|
||||||
|
// 50 Vollschritte pro mm, bei 1/16 Schritt also 800 Schritte pro mm
|
||||||
int mm_to_step(float mm){
|
int mm_to_step(float mm){
|
||||||
return (int)(800 * mm);
|
return (int)(50 * microsteps * mm);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void* StepLibraryMalloc( unsigned int size ){
|
static void* StepLibraryMalloc( unsigned int size ){
|
||||||
@@ -60,7 +67,6 @@ void StepLibraryDelay(unsigned int ms){
|
|||||||
|
|
||||||
// 1 wenn der Treiber nicht fahrbereit ist. L6474_GetStatus selbst meldet nur SPI-Fehler,
|
// 1 wenn der Treiber nicht fahrbereit ist. L6474_GetStatus selbst meldet nur SPI-Fehler,
|
||||||
// die Flags muessen hier ausgewertet werden. HIGHZ bleibt nach OCD/UVLO/TH_SD stehen.
|
// die Flags muessen hier ausgewertet werden. HIGHZ bleibt nach OCD/UVLO/TH_SD stehen.
|
||||||
// Der Aufruf aus StepLibraryStep setzt LIBL6474_HAS_LOCKING 0 voraus.
|
|
||||||
static int StepperHasFault(L6474_Handle_t s){
|
static int StepperHasFault(L6474_Handle_t s){
|
||||||
L6474_Status_t status;
|
L6474_Status_t status;
|
||||||
|
|
||||||
@@ -72,6 +78,9 @@ static int StepperHasFault(L6474_Handle_t s){
|
|||||||
|
|
||||||
// Pulsfrequenz einstellen, nur aufrufen wenn gerade keine Pulse laufen
|
// Pulsfrequenz einstellen, nur aufrufen wenn gerade keine Pulse laufen
|
||||||
static void StepTimerSetSpeed(unsigned int hz){
|
static void StepTimerSetSpeed(unsigned int hz){
|
||||||
|
// hz gilt fuer 1/16 Schritt, bei anderem Step Mode gleiche mm/min halten
|
||||||
|
hz = hz * microsteps / 16;
|
||||||
|
|
||||||
uint32_t arr = (STEP_TICK_HZ / hz) - 1;
|
uint32_t arr = (STEP_TICK_HZ / hz) - 1;
|
||||||
|
|
||||||
stepHz = hz;
|
stepHz = hz;
|
||||||
@@ -115,6 +124,219 @@ void HAL_TIM_OC_DelayElapsedCallback(TIM_HandleTypeDef *htim){
|
|||||||
portYIELD_FROM_ISR(woken);
|
portYIELD_FROM_ISR(woken);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Name des Config-Parameters in die Nummer fuer config_stepper wandeln, 0 wenn unbekannt
|
||||||
|
static int config_param_id(const char* name){
|
||||||
|
if(strcmp(name, "torque") == 0){
|
||||||
|
return 1;
|
||||||
|
}else if(strcmp(name, "throvercurr") == 0){
|
||||||
|
return 2;
|
||||||
|
}else if(strcmp(name, "powerena") == 0){
|
||||||
|
return 3;
|
||||||
|
}else if(strcmp(name, "stepmode") == 0){
|
||||||
|
return 4;
|
||||||
|
}else if(strcmp(name, "timeoff") == 0){
|
||||||
|
return 5;
|
||||||
|
}else if(strcmp(name, "timeon") == 0){
|
||||||
|
return 6;
|
||||||
|
}else if(strcmp(name, "timefast") == 0){
|
||||||
|
return 7;
|
||||||
|
}else if(strcmp(name, "mmperturn") == 0){
|
||||||
|
return 8;
|
||||||
|
}else if(strcmp(name, "posmax") == 0){
|
||||||
|
return 9;
|
||||||
|
}else if(strcmp(name, "posmin") == 0){
|
||||||
|
return 10;
|
||||||
|
}else if(strcmp(name, "posref") == 0){
|
||||||
|
return 11;
|
||||||
|
}else if(strcmp(name, "stepsperturn") == 0){
|
||||||
|
return 12;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int config_stepper(L6474_Handle_t s, int param, float value){
|
||||||
|
/*
|
||||||
|
* param 1: torque (mA)
|
||||||
|
* param 2: throvercurr (mA)
|
||||||
|
* param 3: powerena (0 oder 1)
|
||||||
|
* param 4: stepmode (1, 2, 4, 8, 16)
|
||||||
|
* param 5: timeoff (us)
|
||||||
|
* param 6: timeon (us)
|
||||||
|
* param 7: timefast (us)
|
||||||
|
* param 8: mmperturn
|
||||||
|
* param 9: posmax
|
||||||
|
* param 10: posmin
|
||||||
|
* param 11: posref
|
||||||
|
* param 12: stepsperturn
|
||||||
|
*/
|
||||||
|
|
||||||
|
int reg = 0;
|
||||||
|
int result = 0;
|
||||||
|
|
||||||
|
switch(param){
|
||||||
|
case 1:
|
||||||
|
result = L6474_SetProperty(s, L6474_PROP_TORQUE, L6474_EncodePhaseCurrent(value));
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
// 375 mA pro Stufe, Register 0 = 375 mA
|
||||||
|
if(value < 375 || value > 6000){
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
reg = (int)(value / 375) - 1;
|
||||||
|
result = L6474_SetProperty(s, L6474_PROP_OCDTH, reg);
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
if(value == 1){
|
||||||
|
result = L6474_SetPowerOutputs(s, 1);
|
||||||
|
}else{
|
||||||
|
result = L6474_SetPowerOutputs(s, 0);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 4:
|
||||||
|
if(value == 1){
|
||||||
|
result = L6474_SetStepMode(s, smFULL);
|
||||||
|
}else if(value == 2){
|
||||||
|
result = L6474_SetStepMode(s, smHALF);
|
||||||
|
}else if(value == 4){
|
||||||
|
result = L6474_SetStepMode(s, smMICRO4);
|
||||||
|
}else if(value == 8){
|
||||||
|
result = L6474_SetStepMode(s, smMICRO8);
|
||||||
|
}else if(value == 16){
|
||||||
|
result = L6474_SetStepMode(s, smMICRO16);
|
||||||
|
}else{
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(result == errcNONE){
|
||||||
|
microsteps = (int)value;
|
||||||
|
// Position stimmt nicht mehr, neue Referenzfahrt noetig
|
||||||
|
if(state == 2){
|
||||||
|
state = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 5:
|
||||||
|
// 0.5 us pro Stufe, Register 0 = 0.5 us
|
||||||
|
if(value < 0.5f || value > 64){
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
reg = (int)(value * 2) - 1;
|
||||||
|
result = L6474_SetProperty(s, L6474_PROP_TOFF, reg);
|
||||||
|
break;
|
||||||
|
case 6:
|
||||||
|
// 0.5 us pro Stufe, Register 0 = 0.5 us
|
||||||
|
if(value < 0.5f || value > 64){
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
reg = (int)(value * 2) - 1;
|
||||||
|
result = L6474_SetProperty(s, L6474_PROP_TON, reg);
|
||||||
|
break;
|
||||||
|
case 7:
|
||||||
|
// 2 us pro Stufe, Register 0 = 2 us
|
||||||
|
// obere 4 Bit: TOFF_FAST (wird gesetzt), untere 4 Bit: FAST_STEP (bleibt)
|
||||||
|
if(value < 2 || value > 32){
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
L6474_GetProperty(s, L6474_PROP_TFAST, ®);
|
||||||
|
reg = (((int)(value / 2) - 1) << 4) | (reg & 0x0F);
|
||||||
|
result = L6474_SetProperty(s, L6474_PROP_TFAST, reg);
|
||||||
|
break;
|
||||||
|
case 9:
|
||||||
|
posmax = value;
|
||||||
|
result = errcNONE;
|
||||||
|
break;
|
||||||
|
case 10:
|
||||||
|
posmin = value;
|
||||||
|
result = errcNONE;
|
||||||
|
break;
|
||||||
|
case 11:
|
||||||
|
posref = value;
|
||||||
|
result = errcNONE;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
//TODO param 8 bis 12
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(result != errcNONE){
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int config_stepper_get(L6474_Handle_t s, int param, float* value){
|
||||||
|
//gleiche param Nummern und Einheiten wie bei config_stepper
|
||||||
|
|
||||||
|
int reg = 0;
|
||||||
|
int result = 0;
|
||||||
|
L6474x_State_t driverState;
|
||||||
|
L6474x_StepMode_t mode;
|
||||||
|
|
||||||
|
switch(param){
|
||||||
|
case 1:
|
||||||
|
result = L6474_GetProperty(s, L6474_PROP_TORQUE, ®);
|
||||||
|
*value = (reg + 1) * 31.25f;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
result = L6474_GetProperty(s, L6474_PROP_OCDTH, ®);
|
||||||
|
*value = (reg + 1) * 375;
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
result = L6474_GetState(s, &driverState);
|
||||||
|
if(driverState == stENABLED){
|
||||||
|
*value = 1;
|
||||||
|
}else{
|
||||||
|
*value = 0;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 4:
|
||||||
|
result = L6474_GetStepMode(s, &mode);
|
||||||
|
if(mode == smFULL){
|
||||||
|
*value = 1;
|
||||||
|
}else if(mode == smHALF){
|
||||||
|
*value = 2;
|
||||||
|
}else if(mode == smMICRO4){
|
||||||
|
*value = 4;
|
||||||
|
}else if(mode == smMICRO8){
|
||||||
|
*value = 8;
|
||||||
|
}else{
|
||||||
|
*value = 16;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 5:
|
||||||
|
result = L6474_GetProperty(s, L6474_PROP_TOFF, ®);
|
||||||
|
*value = (reg + 1) * 0.5f;
|
||||||
|
break;
|
||||||
|
case 6:
|
||||||
|
result = L6474_GetProperty(s, L6474_PROP_TON, ®);
|
||||||
|
*value = (reg + 1) * 0.5f;
|
||||||
|
break;
|
||||||
|
case 7:
|
||||||
|
result = L6474_GetProperty(s, L6474_PROP_TFAST, ®);
|
||||||
|
*value = ((reg >> 4) + 1) * 2;
|
||||||
|
break;
|
||||||
|
case 9:
|
||||||
|
*value = posmax;
|
||||||
|
result = errcNONE;
|
||||||
|
break;
|
||||||
|
case 10:
|
||||||
|
*value = posmin;
|
||||||
|
result = errcNONE;
|
||||||
|
case 11:
|
||||||
|
*value = posref;
|
||||||
|
result = errcNONE;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
//TODO param 8 bis 12
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(result != errcNONE){
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static int StepLibraryStep( void* pPWM, int dir, unsigned int numPulses ){
|
static int StepLibraryStep( void* pPWM, int dir, unsigned int numPulses ){
|
||||||
(void)pPWM;
|
(void)pPWM;
|
||||||
|
|
||||||
@@ -145,7 +367,10 @@ static int StepLibraryStep( void* pPWM, int dir, unsigned int numPulses ){
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int cancel_stepper(){
|
||||||
|
TIM1->CR1 &= ~TIM_CR1_CEN;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM){
|
L6474_Handle_t init_stepper(void* pIO, void* pGPO, void* pPWM){
|
||||||
@@ -181,6 +406,7 @@ int reset_stepper(L6474_Handle_t s){
|
|||||||
L6474_BaseParameter_t b;
|
L6474_BaseParameter_t b;
|
||||||
L6474_SetBaseParameter(&b);
|
L6474_SetBaseParameter(&b);
|
||||||
b.stepMode = smMICRO16;
|
b.stepMode = smMICRO16;
|
||||||
|
microsteps = 16;
|
||||||
b.OcdTh = ocdth1125mA;
|
b.OcdTh = ocdth1125mA;
|
||||||
L6474_EncodePhaseCurrentParameter(&b, 700.0f);
|
L6474_EncodePhaseCurrentParameter(&b, 700.0f);
|
||||||
|
|
||||||
@@ -204,7 +430,7 @@ int stepper_reference(L6474_Handle_t s, int flag){
|
|||||||
}
|
}
|
||||||
yellow_led_start();
|
yellow_led_start();
|
||||||
//flag: 0 keiner, 1 -t, 2 -e, 3 -s
|
//flag: 0 keiner, 1 -t, 2 -e, 3 -s
|
||||||
if(HAL_GPIO_ReadPin(REFERENCE_MARK_GPIO_Port, REFERENCE_MARK_Pin) == GPIO_PIN_RESET){
|
if(HAL_GPIO_ReadPin(USR_BUTTON_GPIO_Port, USR_BUTTON_Pin) == GPIO_PIN_SET){
|
||||||
|
|
||||||
if(L6474_StepIncremental(s, mm_to_step(5)) != errcNONE){
|
if(L6474_StepIncremental(s, mm_to_step(5)) != errcNONE){
|
||||||
return 1;
|
return 1;
|
||||||
@@ -216,7 +442,7 @@ int stepper_reference(L6474_Handle_t s, int flag){
|
|||||||
if(L6474_StepIncremental(s, -1) != errcNONE){
|
if(L6474_StepIncremental(s, -1) != errcNONE){
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
if(HAL_GPIO_ReadPin(REFERENCE_MARK_GPIO_Port, REFERENCE_MARK_Pin) == GPIO_PIN_RESET){
|
if(HAL_GPIO_ReadPin(USR_BUTTON_GPIO_Port, USR_BUTTON_Pin) == GPIO_PIN_SET){
|
||||||
button_pressed=1;
|
button_pressed=1;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -235,13 +461,13 @@ int stepper_reference(L6474_Handle_t s, int flag){
|
|||||||
if(L6474_StepIncremental(s, -1) != errcNONE){
|
if(L6474_StepIncremental(s, -1) != errcNONE){
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
if(HAL_GPIO_ReadPin(REFERENCE_MARK_GPIO_Port, REFERENCE_MARK_Pin) == GPIO_PIN_RESET){
|
if(HAL_GPIO_ReadPin(USR_BUTTON_GPIO_Port, USR_BUTTON_Pin) == GPIO_PIN_SET){
|
||||||
button_pressed=1;
|
button_pressed=1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
L6474_SetAbsolutePosition(s, 0);
|
L6474_SetAbsolutePosition(s, mm_to_step(posref));
|
||||||
|
|
||||||
return StepperHasFault(s);
|
return StepperHasFault(s);
|
||||||
|
|
||||||
@@ -256,7 +482,7 @@ int stepper_pos(L6474_Handle_t s){
|
|||||||
if(L6474_GetAbsolutePosition(s, &position) != errcNONE){
|
if(L6474_GetAbsolutePosition(s, &position) != errcNONE){
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
printf("Stepper position: %d", position);
|
printf("%d", (position/(50 * microsteps)));
|
||||||
return StepperHasFault(s);
|
return StepperHasFault(s);
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -276,7 +502,6 @@ int stepper_move(L6474_Handle_t s, int pos){
|
|||||||
|
|
||||||
int pos_diff = pos - position;
|
int pos_diff = pos - position;
|
||||||
|
|
||||||
// StepIncremental lehnt 0 Schritte als Fehler ab
|
|
||||||
if(pos_diff != 0 && L6474_StepIncremental(s, pos_diff) != errcNONE){
|
if(pos_diff != 0 && L6474_StepIncremental(s, pos_diff) != errcNONE){
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
@@ -284,19 +509,24 @@ int stepper_move(L6474_Handle_t s, int pos){
|
|||||||
return StepperHasFault(s);
|
return StepperHasFault(s);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void print_binary_8bit(unsigned int val) {
|
||||||
|
for (int i = 7; i >= 0; i--) {
|
||||||
|
int bit = (val >> i) & 1;
|
||||||
|
printf("%d", bit);
|
||||||
|
if (i == 4) printf(" ");
|
||||||
|
}
|
||||||
|
printf("\r\n");
|
||||||
|
}
|
||||||
|
|
||||||
int StepperConsoleFunction( int argc, char** argv, void* ctx )
|
int StepperConsoleFunction( int argc, char** argv, void* ctx )
|
||||||
// --------------------------------------------------------------------------------------------------------------------
|
|
||||||
{
|
{
|
||||||
//possible commands are
|
|
||||||
//(stepper) step 100
|
|
||||||
(void)argc;
|
(void)argc;
|
||||||
(void)argv;
|
(void)argv;
|
||||||
(void)ctx;
|
(void)ctx;
|
||||||
|
|
||||||
L6474_Handle_t h = (L6474_Handle_t)ctx;
|
L6474_Handle_t h = (L6474_Handle_t)ctx;
|
||||||
|
|
||||||
// first decode the subcommand and all arguments
|
|
||||||
if ( argc == 0 )
|
if ( argc == 0 )
|
||||||
{
|
{
|
||||||
printf("invalid number of arguments\r\n");
|
printf("invalid number of arguments\r\n");
|
||||||
@@ -404,9 +634,28 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
|
|||||||
printf("FAIL\r\n");
|
printf("FAIL\r\n");
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
float target_mm = (float)atof(argv[1]);
|
float target_mm = (float)atof(argv[1]);
|
||||||
|
|
||||||
if (target_mm < 0.0f || target_mm > 100.0f) {
|
if ( argc > 2)
|
||||||
|
{
|
||||||
|
if(strcmp(argv[2], "-s")==0){
|
||||||
|
//TODO: Geschwindigkeit verstellen
|
||||||
|
unsigned int hz = atoi(argv[3]) * 800 / 60;
|
||||||
|
StepTimerSetSpeed(hz);
|
||||||
|
}
|
||||||
|
else if(strcmp(argv[2], "-r")==0){
|
||||||
|
int temp = 0;
|
||||||
|
L6474_GetAbsolutePosition(h, &temp);
|
||||||
|
target_mm = (float)temp / (50 * microsteps) + (float)atof(argv[1]);
|
||||||
|
|
||||||
|
}
|
||||||
|
else if(strcmp(argv[2], "-a")==0){
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
if (target_mm < posmin || target_mm > posmax) {
|
||||||
printf("position out of range\r\n");
|
printf("position out of range\r\n");
|
||||||
printf("FAIL\r\n");
|
printf("FAIL\r\n");
|
||||||
return -1;
|
return -1;
|
||||||
@@ -423,6 +672,133 @@ int StepperConsoleFunction( int argc, char** argv, void* ctx )
|
|||||||
printf("OK\r\n");
|
printf("OK\r\n");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
else if (strcmp(argv[0], "status") == 0)
|
||||||
|
{
|
||||||
|
L6474x_State_t currentState;
|
||||||
|
L6474_Status_t stepperStatus;
|
||||||
|
int moving = 0;
|
||||||
|
|
||||||
|
// 1. get state of state machine
|
||||||
|
if (L6474_GetState(h, ¤tState) != errcNONE)
|
||||||
|
{
|
||||||
|
printf("failed to get state\r\nFAIL");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 2.get driver-state
|
||||||
|
if (L6474_GetStatus(h, &stepperStatus) != errcNONE)
|
||||||
|
{
|
||||||
|
printf("failed to get status\r\nFAIL");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned int errorBits = ((stepperStatus.WRONG_CMD & 0x01) << 8) |
|
||||||
|
((stepperStatus.UVLO & 0x01) << 7) |
|
||||||
|
((stepperStatus.TH_WARN & 0x01) << 6) |
|
||||||
|
((stepperStatus.TH_SD & 0x01) << 5) |
|
||||||
|
((stepperStatus.ONGOING & 0x01) << 4) |
|
||||||
|
((stepperStatus.OCD & 0x01) << 3) |
|
||||||
|
((stepperStatus.NOTPERF_CMD & 0x01) << 2) |
|
||||||
|
((stepperStatus.HIGHZ & 0x01) << 1) |
|
||||||
|
((stepperStatus.DIR & 0x01) << 0);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
// 3. check for moving motor aka async pending operation (should be always 0 with no async mode)
|
||||||
|
L6474_IsMoving(h, &moving);
|
||||||
|
|
||||||
|
|
||||||
|
//TEST CODE START
|
||||||
|
|
||||||
|
unsigned int mappedState = 0x0;
|
||||||
|
|
||||||
|
// check for error (would print 0x8)
|
||||||
|
if (errorBits != 0) {
|
||||||
|
mappedState = 0x8; // scsFLT
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
switch (currentState) {
|
||||||
|
case stRESET:
|
||||||
|
mappedState = 0x1; //map stRESET to scsREF?
|
||||||
|
break;
|
||||||
|
|
||||||
|
case stDISABLED:
|
||||||
|
mappedState = 0x2; //map stDISABLED to scsDIS (driver ready, otuput off)?
|
||||||
|
break;
|
||||||
|
|
||||||
|
case stENABLED:
|
||||||
|
mappedState = 0x4; //map stENABLED to scsENA --> driver active + output on
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
mappedState = 0x0; //entsprciht scsInit
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
printf("0x%X\r\n", mappedState); //print state machine state in first line
|
||||||
|
|
||||||
|
//TEST CODE END
|
||||||
|
|
||||||
|
|
||||||
|
//printf("0x%X\r\n", (unsigned int)currentState); //print state in first line
|
||||||
|
printf("0x%X\r\n", errorBits); //print error flags in second line
|
||||||
|
printf("internal error bits in binary: ");
|
||||||
|
print_binary_8bit(errorBits);
|
||||||
|
|
||||||
|
printf("%d\r\n", moving); //print async pending op in third line
|
||||||
|
printf("OK");
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[0], "config") == 0)
|
||||||
|
{
|
||||||
|
if ( argc < 2 ){
|
||||||
|
printf("missing parameter name for config command\r\n");
|
||||||
|
printf("FAIL\r\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
int param = config_param_id(argv[1]);
|
||||||
|
|
||||||
|
if(param == 0){
|
||||||
|
printf("unknown config parameter\r\n");
|
||||||
|
printf("FAIL\r\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Ohne Flag: Wert lesen -> config <param>
|
||||||
|
if ( argc == 2 ){
|
||||||
|
float value = 0.0f;
|
||||||
|
|
||||||
|
if(config_stepper_get(h, param, &value) != 0){
|
||||||
|
printf("FAIL\r\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf("%.2f\r\n", value);
|
||||||
|
printf("OK\r\n");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Mit Flag: Wert schreiben -> config <param> -v <value>
|
||||||
|
if ( argc >= 4 && strcmp(argv[2], "-v") == 0 ){
|
||||||
|
float value = (float)atof(argv[3]);
|
||||||
|
|
||||||
|
if(config_stepper(h, param, value) != 0){
|
||||||
|
printf("FAIL\r\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf("OK\r\n");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf("usage: config <param> [-v <value>]\r\n");
|
||||||
|
printf("FAIL\r\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
printf("passed invalid sub command\r\n");
|
printf("passed invalid sub command\r\n");
|
||||||
|
|||||||
@@ -183,20 +183,20 @@ static int CapabilityFunc( int argc, char** argv, void* ctx )
|
|||||||
0, // has stepper refrun timeout
|
0, // has stepper refrun timeout
|
||||||
0, // has stepper refrun skip
|
0, // has stepper refrun skip
|
||||||
0, // has stepper refrun stay enabled
|
0, // has stepper refrun stay enabled
|
||||||
0, // has stepper reset
|
1, // has stepper reset
|
||||||
1, // has stepper position
|
1, // has stepper position
|
||||||
0, // has stepper config
|
1, // has stepper config
|
||||||
0, // has stepper config torque
|
2, // has stepper config torque
|
||||||
0, // has stepper config throvercurr
|
1, // has stepper config throvercurr
|
||||||
0, // has stepper config powerena
|
1, // has stepper config powerena
|
||||||
0, // has stepper config stepmode
|
1, // has stepper config stepmode
|
||||||
0, // has stepper config timeoff
|
1, // has stepper config timeoff
|
||||||
0, // has stepper config timeon
|
1, // has stepper config timeon
|
||||||
0, // has stepper config timefast
|
1, // has stepper config timefast
|
||||||
0, // has stepper config mmperturn
|
0, // has stepper config mmperturn
|
||||||
0, // has stepper config posmax
|
1, // has stepper config posmax
|
||||||
0, // has stepper config posmin
|
1, // has stepper config posmin
|
||||||
0, // has stepper config posref
|
1, // has stepper config posref
|
||||||
0, // has stepper config stepsperturn
|
0, // has stepper config stepsperturn
|
||||||
0 // has stepper cancel
|
0 // has stepper cancel
|
||||||
);
|
);
|
||||||
|
|||||||
Reference in new issue
Block a user