feat: add j3,j4,j5
This commit is contained in:
+51
-12
@@ -27,22 +27,61 @@ MainLoop::MainLoop() noexcept:
|
||||
-38.0,
|
||||
85.0,
|
||||
180.0,
|
||||
50,
|
||||
0,
|
||||
172,
|
||||
565
|
||||
),
|
||||
AdafruitServoMotor(
|
||||
pwmBoard,
|
||||
2,
|
||||
1.0,
|
||||
1.0,
|
||||
123.0,
|
||||
-123.0,
|
||||
57.0,
|
||||
180.0,
|
||||
-123,
|
||||
172,
|
||||
565
|
||||
2, // index
|
||||
1.0, // gearbox
|
||||
1.0, // scale calibration
|
||||
40.0, // zero offset
|
||||
-90.0, // min
|
||||
90.0, // max
|
||||
180.0, // spec range
|
||||
0, // initial pos
|
||||
172, // min pulse
|
||||
565 // max pulse
|
||||
),
|
||||
AdafruitServoMotor(
|
||||
pwmBoard,
|
||||
3, // index
|
||||
1.0, // gearbox
|
||||
1.0, // scale calibration
|
||||
90.0, // zero offset
|
||||
-90.0, // min
|
||||
90.0, // max
|
||||
180.0, // spec range
|
||||
0, // initial pos
|
||||
80, // min pulse
|
||||
600 // max pulse
|
||||
),
|
||||
AdafruitServoMotor(
|
||||
pwmBoard,
|
||||
4, // index
|
||||
1.0, // gearbox
|
||||
1.0, // scale calibration
|
||||
90.0, // zero offset
|
||||
-90.0, // min
|
||||
90.0, // max
|
||||
180.0, // spec range
|
||||
0, // initial pos
|
||||
80, // min pulse
|
||||
600 // max pulse
|
||||
),
|
||||
AdafruitServoMotor(
|
||||
pwmBoard,
|
||||
5, // index
|
||||
1.0, // gearbox
|
||||
1.0, // scale calibration
|
||||
90.0, // zero offset
|
||||
-90.0, // min
|
||||
90.0, // max
|
||||
180.0, // spec range
|
||||
0, // initial pos
|
||||
80, // min pulse
|
||||
600 // max pulse
|
||||
),
|
||||
})
|
||||
{
|
||||
@@ -65,7 +104,7 @@ MainLoop& MainLoop::getInstance() noexcept
|
||||
void MainLoop::setup() noexcept
|
||||
{
|
||||
UartHandler::getInstance().init(9600);
|
||||
for (uint8_t i = 0; i < 3; i++) {
|
||||
for (uint8_t i = 0; i < 5; i++) {
|
||||
motors[i].commitMoveImmediately();
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user