Hi All,
I’ve been working on this project for a couple of weeks now. The project includes a A4WD1 Rover with a AL5B Arm mounted on top. The arm got a total of 6DOF controlled using IK.
Hardware setup:
A4WD1 Rover
AL5B Arm
Electronics:
Bot Board 2
Basic Atom 28 Pro
Sabertooth
6V 2800mAh NiMH battery for logic and servos
12V 1600mAh NiMH battery for the wheels
I started out by stripping my phoenix code down to a single leg and added the wrist in the IK calculations. The arm IK is calculated in 2D and includes shoulder, elbow and wrist servos. The gripper, wrist rotate and base are directly controlled by the remote. I’ve also tried including the base in the IK to get 3D control but this wasn’t easy to control with a remote.
There is no SSC used in this project. The 6 servos are driven by a interrupt routine which makes it possible to do group moves and control both positions and speed with the BAP. Because the servos are controlled with the use of interrupts it is possible to drive the servos and do IK calculations at the same time. I used a program from Nathan (AcidTech) as example for the group move. Can’t find the link so I’ll post that later on.
Time for some pictures!
The video is showing the current status. [ame=http://www.youtube.com/watch?v=ImNEj4KAIoQ]here[/ame]
Xan
Bookmarks