OpenIPC
/
firmware
mirror of https://github.com/OpenIPC/firmware.git
1
0
Fork 0
Code Activity

[no ci] Sigmastar: update motor sample

pull/1231/head
Viktor 2024-01-03 21:46:31 +01:00
parent 49ab5d06e4
commit 65d6872300
2 changed files with 10 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
general/package/sigmastar-motors/src/Makefile
View File

@ -1,3 +1,3 @@
motor:
mkdir -p output
$(CC) motor_foscam.c -o output/$@ -s -Wall
$(CC) $@.c -o output/$@ -s -Wall

16
general/package/sigmastar-motors/src/motor_foscam.c → general/package/sigmastar-motors/src/motor.c
View File

@ -13,8 +13,10 @@
#define MAX_COUNT 8
#define SEQ_COUNT 8
int gpio_x[] = {01, 02, 12, 13};
int gpio_y[] = {62, 63, 64, 65};
int device_x5[] = {01, 02, 12, 13, 62, 63, 64, 65};
int gpio_x[4];
int gpio_y[4];
int sequence[][4] = {
{1, 0, 0, 0}, {1, 1, 0, 0}, {0, 1, 0, 0}, {0, 1, 1, 0},
@ -99,20 +101,20 @@ int main(int argc, char **argv) {
int x = limit_value(argv[1] ? atoi(argv[1]) : 0);
int y = limit_value(argv[2] ? atoi(argv[2]) : 0);
memcpy(gpio_x, device_x5 + 0, sizeof(gpio_x));
memcpy(gpio_y, device_x5 + 4, sizeof(gpio_y));
if (gpio_export(gpio_x) || gpio_export(gpio_y)) {
return -1;
}
int x_max = (x < 0) ? -x : x;
int y_max = (y < 0) ? -y : y;
for (int i = 0; i < x_max * STEP_COUNT * 2; i++) {
for (int i = 0; i < abs(x) * STEP_COUNT * 2; i++) {
if (motor_control(gpio_x, (x < 0) ? SEQ_COUNT : 0)) {
goto reset;
}
}
for (int i = 0; i < y_max * STEP_COUNT; i++) {
for (int i = 0; i < abs(y) * STEP_COUNT; i++) {
if (motor_control(gpio_y, (y < 0) ? 0 : SEQ_COUNT)) {
goto reset;
}