deepseek Bot
324d114386
- Add platformio.ini for ESP32 DevKit (Arduino framework, espressif32 6.10.0) - Vendor ArduinoJson, MPU6050_tockn, SCServo, Simple_FOC, and WebSockets so a fresh clone builds without downloading dependencies - Add .gitignore rules for PlatformIO/IDE build artifacts - Add controller PCB Gerber and drill files
37 lines
936 B
Arduino
37 lines
936 B
Arduino
/*
|
||
The RegWritePos example passed the test in ST3215 Servo,
|
||
and if testing other models of ST series servos
|
||
please change the appropriate position, speed and delay parameters.
|
||
*/
|
||
|
||
#include <SCServo.h>
|
||
|
||
SMS_STS st;
|
||
|
||
// the uart used to control servos.
|
||
// GPIO 18 - S_RXD, GPIO 19 - S_TXD, as default.
|
||
#define S_RXD 18
|
||
#define S_TXD 19
|
||
|
||
|
||
void setup()
|
||
{
|
||
Serial.begin(115200);
|
||
Serial1.begin(1000000, SERIAL_8N1, S_RXD, S_TXD);
|
||
st.pSerial = &Serial1;
|
||
delay(1000);
|
||
}
|
||
|
||
void loop()
|
||
{
|
||
st.RegWritePosEx(1, 4095, 3400, 50);//servo(ID1) speed=3400，acc=50，move to position=4095.
|
||
st.RegWritePosEx(2, 4095, 3400, 50);//servo(ID2) speed=3400，acc=50，move to position=4095.
|
||
st.RegWriteAction();
|
||
delay(3000);
|
||
|
||
st.RegWritePosEx(1, 0, 3400, 50);//servo(ID1) speed=3400，acc=50，move to position=0.
|
||
st.RegWritePosEx(2, 0, 3400, 50);//servo(ID2) speed=3400，acc=50，move to position=0.
|
||
st.RegWriteAction();
|
||
delay(3000);
|
||
}
|