Reference + move funktioniert (Fehlerbehandlung muss implementiert werden)
This commit is contained in:
1 parent
26b117b63f
commit
6a9a634df0
1 file changed
+100
-47
@@ -2,52 +2,6 @@
|
|||||||
#include "LibL6474.h"
|
#include "LibL6474.h"
|
||||||
#include "main.h"
|
#include "main.h"
|
||||||
|
|
||||||
int StepperConsoleFunction( int argc, char** argv, void* ctx )
|
|
||||||
// --------------------------------------------------------------------------------------------------------------------
|
|
||||||
{
|
|
||||||
//possible commands are
|
|
||||||
//(stepper) step 100
|
|
||||||
(void)argc;
|
|
||||||
(void)argv;
|
|
||||||
(void)ctx;
|
|
||||||
|
|
||||||
L6474_Handle_t h = (L6474_Handle_t)ctx;
|
|
||||||
|
|
||||||
// first decode the subcommand and all arguments
|
|
||||||
if ( argc == 0 )
|
|
||||||
{
|
|
||||||
printf("invalid number of arguments\r\nFAIL");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
else if ( strcmp(argv[0], "step") == 0 )
|
|
||||||
{
|
|
||||||
|
|
||||||
if ( argc < 2 )
|
|
||||||
{
|
|
||||||
printf("missing step value for step command\r\nFAIL");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
L6474_StepIncremental(h, atoi(argv[1]));
|
|
||||||
printf("%d steps", (int)atoi(argv[1]));
|
|
||||||
|
|
||||||
}
|
|
||||||
else if ( strcmp(argv[0], "reset") == 0 )
|
|
||||||
{
|
|
||||||
reset_stepper(h);
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
printf("passed invalid sub command\r\nFAIL");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
// now back to console
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static void* StepLibraryMalloc( unsigned int size ){
|
static void* StepLibraryMalloc( unsigned int size ){
|
||||||
return malloc(size);
|
return malloc(size);
|
||||||
@@ -145,6 +99,22 @@ void reset_stepper(L6474_Handle_t s){
|
|||||||
|
|
||||||
void stepper_reference(L6474_Handle_t s, int flag){
|
void stepper_reference(L6474_Handle_t s, int flag){
|
||||||
//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){
|
||||||
|
|
||||||
|
L6474_StepIncremental(s, 1000);
|
||||||
|
|
||||||
|
int button_pressed = 0;
|
||||||
|
|
||||||
|
while(!button_pressed){
|
||||||
|
L6474_StepIncremental(s, -1);
|
||||||
|
if(HAL_GPIO_ReadPin(REFERENCE_MARK_GPIO_Port, REFERENCE_MARK_Pin) == GPIO_PIN_RESET){
|
||||||
|
button_pressed=1;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
if(flag == 3){
|
if(flag == 3){
|
||||||
L6474_SetAbsolutePosition(s, 0);
|
L6474_SetAbsolutePosition(s, 0);
|
||||||
return;
|
return;
|
||||||
@@ -153,7 +123,7 @@ void stepper_reference(L6474_Handle_t s, int flag){
|
|||||||
|
|
||||||
while(!button_pressed){
|
while(!button_pressed){
|
||||||
L6474_StepIncremental(s, -1);
|
L6474_StepIncremental(s, -1);
|
||||||
if(HAL_GPIO_ReadPin(USR_BUTTON_GPIO_Port, USR_BUTTON_Pin) == GPIO_PIN_RESET){
|
if(HAL_GPIO_ReadPin(REFERENCE_MARK_GPIO_Port, REFERENCE_MARK_Pin) == GPIO_PIN_RESET){
|
||||||
button_pressed=1;
|
button_pressed=1;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -165,3 +135,86 @@ void stepper_reference(L6474_Handle_t s, int flag){
|
|||||||
void stepper_softstart(L6474_Handle_t s, unsigned int duration){
|
void stepper_softstart(L6474_Handle_t s, unsigned int duration){
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void stepper_pos(L6474_Handle_t s){
|
||||||
|
int position = 0;
|
||||||
|
L6474_GetAbsolutePosition(s, &position);
|
||||||
|
printf("Stepper position: %d", position);
|
||||||
|
}
|
||||||
|
|
||||||
|
void stepper_move(L6474_Handle_t s, int pos){
|
||||||
|
int position = 0;
|
||||||
|
L6474_GetAbsolutePosition(s, &position);
|
||||||
|
|
||||||
|
int pos_diff = pos-position;
|
||||||
|
|
||||||
|
|
||||||
|
L6474_StepIncremental(s, pos_diff);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int StepperConsoleFunction( int argc, char** argv, void* ctx )
|
||||||
|
// --------------------------------------------------------------------------------------------------------------------
|
||||||
|
{
|
||||||
|
//possible commands are
|
||||||
|
//(stepper) step 100
|
||||||
|
(void)argc;
|
||||||
|
(void)argv;
|
||||||
|
(void)ctx;
|
||||||
|
|
||||||
|
L6474_Handle_t h = (L6474_Handle_t)ctx;
|
||||||
|
|
||||||
|
// first decode the subcommand and all arguments
|
||||||
|
if ( argc == 0 )
|
||||||
|
{
|
||||||
|
printf("invalid number of arguments\r\nFAIL");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
else if ( strcmp(argv[0], "step") == 0 )
|
||||||
|
{
|
||||||
|
|
||||||
|
if ( argc < 2 )
|
||||||
|
{
|
||||||
|
printf("missing step value for step command\r\nFAIL");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
L6474_StepIncremental(h, atoi(argv[1]));
|
||||||
|
|
||||||
|
printf("%d steps", (int)atoi(argv[1]));
|
||||||
|
|
||||||
|
}
|
||||||
|
else if ( strcmp(argv[0], "reset") == 0 )
|
||||||
|
{
|
||||||
|
reset_stepper(h);
|
||||||
|
}
|
||||||
|
else if ( strcmp(argv[0], "reference") == 0 )
|
||||||
|
{
|
||||||
|
stepper_reference(h, 0);
|
||||||
|
}
|
||||||
|
else if ( strcmp(argv[0], "pos") == 0 )
|
||||||
|
{
|
||||||
|
stepper_pos(h);
|
||||||
|
}
|
||||||
|
else if ( strcmp(argv[0], "move") == 0 )
|
||||||
|
{
|
||||||
|
if ( argc < 2 )
|
||||||
|
{
|
||||||
|
printf("missing step value for move command\r\nFAIL");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
stepper_move(h, atoi(argv[1]));
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
printf("passed invalid sub command\r\nFAIL");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
// now back to console
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
Reference in new issue
Block a user