|
CT433-HSWF20DR TMR Current Sensor Compact Carrier 0A to 20A, 3.3V |
|
JST SH-Style Cable, 4-Pin, Female-Female, 40cm |
|
ACS37030LLZATR-040B3 Current Sensor Compact Carrier -40A to +40A, 3.3V |
|
Pololu RC Switch with Isolated Solid State Relay/Switch, SPST, 60V, 6A (Soldered Connectors) |
|
JST PH-Style Cable with Female Pins for 0.1" Housings, 4-Pin, 12cm |
|
12V, 4.5A Step-Down Voltage Regulator D42V55F12 |
|
TB67S581FNG Stepper Motor Driver Carrier (Soldered Header Pins) |
|
Breakout for JST PH-Style Connector, 3-Pin Male Side-Entry, with SH |
|
6V, 500mA Step-Down Voltage Regulator D45V5F6 |
|
ACS37042KLHBLT-030B3 Current Sensor Micro Carrier -30A to +30A, 3.3V |
How to make a Balboa robot balance, part 4: a balancing algorithm
- 29 January 2018’m Back.
Hey, with further sleuthing of code I’m guessing… are you folks reading the accelerometer values in Balance.cpp?
It seems like there is testing if there is greater than 0 values in Z at rest . and a test with the x axis to run the standup code. I’m I right? Is it possible these tests are not > 0 at 90 degrees?
thanks in advance.
How to make a Balboa robot balance, part 4: a balancing algorithm
- 29 January 2018Hi,
I can get my balboa with arms installed to balance, if I start it standing up, but it will not stand up from a 90 or 85 degree angle lying down.(the angle the robot rests at lying down with the arms installed.)
I have been changing these values in Balance.cpp:
if (angleRate > -2 && angleRate < 2)
{
// It's really calm, so we know the angles.
if (imu.a.z > 0)
{
angle = 110000; changed to 90000 or 80000
}
else
{
angle = -110000; changed to -90000 or -80000
}
distanceLeft = 0;
distanceRight = 0;
}
}
I am I on the wrong track?
I cannot get the red led on with the initial standup code to engage when I press button A.
What part of the balance program “sees” the resting angle when the robot is face down at 110 degrees?
Where should I look to change it to about 87 degrees?