Thumbnail

Inverted Pendulum

by Synthiam

The inverted pendulum skill is designed to be used with the Sainsmart v3 balance robot but technically you can use the Sainsmart hardware, combined with ARC, to balance any robot.

How to add the Inverted Pendulum robot skill

  1. Load the most recent release of ARC (Get ARC).
  2. Press the Project tab from the top menu bar in ARC.
  3. Press Add Robot Skill from the button ribbon bar in ARC.
  4. Choose the Movement Panels category tab.
  5. Press the Inverted Pendulum icon to add the robot skill to your project.

Don't have a robot yet?

Follow the Getting Started Guide to build a robot and use the Inverted Pendulum robot skill.

How to use the Inverted Pendulum robot skill

The inverted pendulum skill is designed to be used with the Sainsmart v3 balance robot but technically you can use the Sainsmart hardware, combined with ARC, to balance any robot. You'll just need some patience to tune the PID values. In order to use this skill you'll have to install the custom EZB firmware onto the Sainsmart robot's Arduino Mega and connect it to ARC.  

Main window


User-inserted image


1. PID Gain Value Sliders
These sliders adjust the proportional, integral, and derivative (Kp, Ki, and Kd) values that are used for the closed loop balancing algorithm.

2. Values Display & Update Realtime Checkbox
The Kp, Ki, and Kd values are displayed here as well as Omega, Angle, Distance, encoder values, angle offset, and speed values. The Checkbox is used for showing realtime values if needed.

3. Angle Correction Offset Slider
Correct the angle of your balancing robot with this slider.

4. Movement panel
This panel allows you to move the balancing robot, forward, reverse, left and right. 

5. Calibrate Button
This button sends the Calibration command to the Arduino Mega.

6. Status Display
This displays communication between ARC and the Arduino Mega.

How to Use Inverted Pendulum


1) Download the EZB firmware onto the Sainsmart Balancing robot's Arduino Mega.

2) Add the Inverted Pendulum Skill to your ARC project (Project -> Add Skill -> Movement Panels -> Inverted Pendulum).

3) Connect the Arduino Mega's COM port to ARC with a USB cable or Bluetooth.

4) Push the Calibrate button then start adjusting the sliders in the Inverted Pendulum Skill until you have optimal balancing. Adjust Kp, then Kd, and then Ki. Note that Kp is a usually higher in value and Kd is a very low value.

Video




Requirements


You will have to program the EZB firmware onto the Arduino Mega, located on the hardware page, in order to use this skill.

Resources


The hardware for this skill can be found here: https://synthiam.com/Docs/Hardware/SainSmart-Balance-Robot

Here is the Inverted Pendulum firmware for the Arduino Mega: https://synthiam.com/uploads/imagesrc/EZ-Mega-v1_Balance_Robot-636848728401310251.zip

The tutorial for installing the EZB firmware onto an Arduino Mega is here: https://synthiam.com/Community/Tutorials/Connecting-Arduino-to-EZ-Builder-17526

*Note: This skill is in beta stages

ARC Pro

Upgrade to ARC Pro

Get access to the latest features and updates with ARC Early Access edition. You'll have everything that's needed to unleash your robot's potential!

PRO
Synthiam
#2   — Edited
Fixed URL. I'll also have that old URL redirected because there's a ton of content posting to that old url that wasn't updated. Thanks for letting me know
#4  
Problems connecting skill to Arduino error message:
Connected device to EZ-B index #0 does not support the required capability. Field not found: 'EZ_B.Firmware.XMLFirmwareSimulator.CAP_INVERTED_PENDULUM_V1'.

The baud rate in the sketch is set to 115200 as is the baud rate in the EZ-B.
The firmware id = 9

// The firmware version that is reported to ARC to notify of capabilities
#define _FIRMWARE_ID 0x00000009

// The communication baud rate
#define _BAUD_RATE 115200

This is my first attempt with Arc. Is there a way to test the communication to the arduino from the arduino serial monitor?
PRO
Synthiam
#5  
You got that error because it’s not the correct firmware. The capability for inverted pendulum isn’t supported, says the error

The correct firmware is posted above
#6  
Thanks for the suggestion.
However I downloaded the firmware from the above location.
file name: EZ-Mega-v1_Balance_Robot-636848728401310251.zip
file size: 65,776 bytes

The firmwareID in the source code is: #define _FIRMWARE_ID 0x00000009

I have reduced the baud rate on both the Arduino and in the connection dialog. With no improvement.
I do not get a connection if the baud rates are not aligned.

Is there a way to get the commands send by the Skill to the Arduino? So i can simulate that with the Arduino Serial Monitor.

PS. I added a blinker to main loop of the code to see if the code is running on the mega, which it is.
#7   — Edited
Here the output from the Debug Log

Code:

EZB 0: 
EZB 1:
EZB 2:
EZB 3:
EZB 4:
Windows version: Microsoft Windows NT 10.0.22621.0
Screen Resolution: 2560x1440 (96x96 dpi)
ARC (Teams) Version: 2022.02.22.00
Attempting connection on COM4
Connected to COM4 at 115200
Reports CapabilityController
Firmware 'DJ's Inverted Pendulum' on 'Arduino Mega' supports the following capabilities:
- Native USB Connectivity from ARC
- Inverted pendulum v1 PID movement panel

Connected
PRO
Synthiam
#8  
It shows it’s connected. The thing about arduino is there’s only one usb port. So you can’t use the serial monitor and connect at the same time. It’s one or the other.
#9  
Hi do I need to "connect" the connection element on the workspace to the inverted pendulum element on the workspace? And if so how do I do that or where can i find to do that?
Moreover with no Arduino connected I get the same error so it seems the Inverted Pendulum is not aware of the connection when connected.
Thanks for you support.
#10  
This is my workspace.
User-inserted image
#11   — Edited
When connected, you can view the capabilities of the EZB. View the Debug Log window after a connection to review the list of capabilities.

Also, the message reads Index #0, and you are using Index #1. Use Index #0 as the message describes, and do not use Index #1.
#12  
Hi, Thanks for your suggestions.
Tried those with the same result. Attached four screenshots.
1 Workspace with connection (0)
2 Debug log at that state
3 Workspace after pressing calibrate
4 debug log at that state

Note no new entries in the debug-log between 2 and 4

User-inserted image



User-inserted image



User-inserted image



User-inserted image
#13  
Hi I did some further troubleshooting.
I created a project with the serial terminal skill.
I changed the #define CmdGetFirwareID 253 to 0x5A // Z Change for testing with Serial console.

When I send "U Z", I get this response back:

Code:

0xDE 0x09 0x00 0x00 0x00

Which is expected, see attached screenshot.
Any change to get access to the code of the Inverted-Pendulum for further trouble shooting as I'm now stuck.
Thanks in advance.


User-inserted image
PRO
Synthiam
#14  
I can post it on github for you:)

I can take a look at it as well to see what's up. It should be pretty straightforward. But either way, I'll get it up fro you to look at
#15  
Thank you very much,
PRO
Synthiam
#16  
Here you go! You'll have to configure the output folder to be your plugin folder + guid.

So if your plugins are in 

Quote:


C:\ProgramData\ARC\Plugins


Then you'll want the output folder to be that path plus the GUID. So it'll be

Quote:


C:\ProgramData\ARC\Plugins\462e9d36-08b3-40ec-8b66-4123c4b144d7


If you want to create your version, create a plugin, copy the GUID from the new plugin and replace it in the plugin.xml of this one.