4 axis palletized robot arm (robot kinematics) for 3D printing

droftarts

@o_lampe that looks interesting. From a quick look at the pictures, the extra linkages are doing the same (probably a better) job as the cables in my arm.

Ian

o_lampe

@droftarts As JoergS5 already said: the linkages make sure that the toolhead is always horizontal. Your arm has some deluxe options which are not palletizing-compatible.

droftarts

@o_lampe right I get it now. The tool head is kept horizontal (or vertical) and there’s no control over that. My arm has the extra controllable wrist joint, which makes it a five or six axis arm, I suppose. If I ignore that for now, I think I can still test the 4 axis palletised firmware.

Ian

JoergS5

@o_lampe said in 4 axis palletized robot arm (robot kinematics) for 3D printing:

robot kinematics expect a step/dir interface, I guess

the kinematics is integrated in RRF like the other kinematics. So the capabilites in respect to controlling interfaces are the same.

The Sainsmart has no parallelogram, but I analyzed it some time ago: the triangle on top has the same function, when thinking through the angles. Some of the commercial big robots use the same triangle construction (Kuka KR 700 eg).

Two parallelograms, conntected with a fixed triangle. Advantage: arms can be "bent down", disadvantage: more hinges, probably with play = less precision. For 3D printers, it may be better to construct it with a true parallelogram and the actuators higher placed.

JoergS5

If someone is interested to 3D print a 4 axis palletized, the MeArm 3.0 on Thingiverse https://www.thingiverse.com/thing:3420797 seems to be one. I'll take this for me to build one. I work this weekend on the firmware implementation.

A fork with steppers: https://www.thingiverse.com/thing:970881
There are other versions, searchable by MK2 design or Kuka 180 (= Kuka KR 180 PA).

o_lampe

@JoergS5 I found another one with NEMA17 motors, but it's quite outdated.
It uses spur gears instead of GT2 belts, which would be the minimum requirement for me to build one.

alt text

YuriConfessor

Hello guys, I've been able to include the DH parameters directly to the gcode by creating a slicer using grasshopper. But this solution is not pratical in any form. @JoergS5 is it possible to launch a firmware with the DH enabled on the K13 so I can figure the robot directly on the config file? I'm using a cartesian kinematics and tricking the machine with the gcode. Here is a short video of it "building" a cillinder: lRobot kinda working

JoergS5

@YuriConfessor I will provide an unfinished version on Feb 24/25 for your printer type, which is missing some features like velocity/angle checks. I'll provide a Duet 2 binary for you.

YuriConfessor

@JoergS5 Ok, thank you! I'll post here if I have any updates

Nakcam

Any uppdates on this? Im trying to get inverse kinematics working on the same type of robot.

I might be wrong but this should be a serial scara but when axis 1 moves axis 2 need to follow to keep the relative angle (axis 1 to 2) the same? the relative move should be a 1:1 = just add axis 1 moves to axis 2?

JoergS5

@Nakcam it's more complicated then serial Scara:

the platform in front stays horizontal, due to the arm's nature: they make movements of a parallelogram, which means some of the arms stay parallel. The calculation is simliar to 5 bar paralleld scara, where two actuators together make a movement which is restricted by the connection at the end point. The inverse kinematics must calculate back with this restriction, with the added problem that there are multiple solutions for the inverse kinematics.

Your image looks fine, but differs from the black robot model: the back arms of his model are fix connected to the platform at the bottom. (looking from back, the left one)

Do you have a prototype, or only the drawing? If you have a working model or prototype, please give me information about how it is built exactly. (which of the arms are connected to the actuators=steppers, which are only connected through hinge, but not driven by the stepper)

Nakcam

@JoergS5 Thanks for the reply. I have now found the robot 4 axis pelletized section of the duet3d documentation ( duet3d*/User_manual/Machine_configuration/robot_4_axis_palletized), this sould be a perfekt fitt.
I have uploaded the "github*/JoergS5/RepRapFirmware_robot" firmware to the board and run the firmware update. But now im stuck with :

M669 K13 B"axisTypes=PRRRp"
currently only CoreXY5AC and CoreXY5BC are support

and it wont take the D values

=== M669 K13 current config ===
numOfAxes 5 axisTypes �� chain �� (normal �� special ��)
axis � ori: -0.00 0.00 0.00 point: -0.00 0.00 0.00 angles min/max/home: -0.00 0.00 0.00
axis � ori: 0.00 0.00 0.00 point: 0.00 0.00 0.00 angles min/max/home: 0.00 0.00 0.00
axis � ori: 0.00 0.00 0.00 point: 0.00 0.00 0.00 angles min/max/home: 0.00 0.00 0.00
axis � ori: 0.00 0.00 0.00 point: 0.00 0.00 0.00 angles min/max/home: 0.00 0.00 0.00
axis � ori: 0.00 0.00 0.00 point: 0.00 0.00 0.00 angles min/max/home: 0.00 0.00 0.00
Screw values:
reference angles/positions: -0.00 0.00 0.00 0.00 0.00
endpoint axis X: -0.00 -0.00 -0.00
endpoint axis Y: -0.00 -0.00 -0.00
endpoint axis Z: -0.00 -0.00 -0.00
endpoint point: -0.00 -0.00 -0.00
abSign: 0 (A/B angle preference: 0 take >=0, 1 take <= 0, 2 don't change calculation
cache used: -1 maximum: 200

Mine is the same as yours with one arm fixt to the base (mine is to the right seen from behind)
I do have a fysikal protorype. Screenshot 2025-02-06 104248.jpg config (1).g

Nakcam

@Nakcam This is a old picture, it does have motors and move. But not with Inverse kinematic VID20250128172507-ezgif.com-optimize.gif

JoergS5

@Nakcam the kinematics is not implemented yet, but I'll try to do it with your help.

Please confirm or correct me:

1 is connected with first actuator/stpper
2 is connected with the other
3 is connected to base
4 is a hinge connecting three parts: tringle low, big arm and other big arm

Your short video looks like the front horizontal platform tilts a bit, the front going a bit down. This may be an optical illustion. But if it's real, then some of the angles are wrong and the construction is not a parallelogram. Maybe you'll need to change the prototype a bit. But let's make the kinematics first.

BTW I like your prototype, because the gear is belt based, which means low or no backlash. The planetary based gears have some play when changing orientation of the rotations.

Nakcam

@JoergS5 Thanks for helping out! You are correct on how the linkage work (point 1-4). The platform is tilted a bit, but the tilt does not change when moving (it does a tiny bit but that's because of sloop in the system, i did not have all the right fasteners at hand). I am working on a updated version that uses Capstan-Drive system. I would like to get this working first.
here's a fusion 360 link to the cad model
a360.**/42M19T2

in using 1.8degree steppers and total gearing is 51,8 (5,18:1+200:20)

JoergS5

@Nakcam I can work next weekend on it, and it would be nice if you can make some tests with the prototype, verifiying code, while I develop the code. I can provide you the RRF binary for each test.

Nakcam

@JoergS5 Sounds great! Is there some "hack" to force the D values for now? Or is the robot firmware on github not working?

JoergS5

@Nakcam the D values make only sense when the axes are calculated in the chain. This is only implemented for CoreXY. I you want to test setting D values in advance, just define your config for CoreXY.

Nakcam

@JoergS5 Ok. I will wait for your test bin files then. here is some dimensions of my arm

JoergS5

@Nakcam thank you! I don't have Fusion, so from your image I can make a prototype as well.

Please measure the triangle lenghts as well, from hinge to hinge each.