Well, we applied the Fast Measure inputs on X33.
The interrupt is works very nice, also the rotation around the sensor.
But i am struggling whit the offset i calculate.
First, what i want to achieve are the following offsets:
Finding the Rotation around Z-Axis. in The tool the A-Offset.
The width of the panel. X-Offset in the tool.
At last the length of the panel. Y-Offset of the tool.
If i have these values i have the distance and orientation from he panel corner related to my origin of my tool.
What i do:
1. Move panel to S2 and S3 (see attachment in previous post).
2. When S2 or S3 is triggered, save the position when triggered. then rotate around it.
3. If opposite sensor is detected,save the position when triggered and the panel is aligned whit the sensors.
4. now i can do the calculation of the orientation. i calculate them by comparing the angle of the base of S1 and S2. then subtract the actual rotation of the gripper (keeping in mind -180/180)
This works fine. If i put the offset angle in the new tool, the robot keeps the orientation.
5. Now i have the rotation of the panel aligned whit the sensors, I'm able to compare the actual robot position with the sensor position on X-axis.
the difference between them is the Offset. And apply the offset into the new tool.
6. then move to S1. when sensor triggered i subtract actual position with sensor Position.
After All i activate the tool and move in another base towards an point for example X 100, Y 100, A 180, B,0 C 180
This seems to work, but I'm struggling on the next situation.
when testing i move the robot to an fixed Pick-Up position.
The panel is random placed, after positioning the panel Will move to an point suggested before.
i have drawn the contours of the panel on an paper when positioning done, sow i can check the repeatability of the system.
But when i Retry the procedure, and chance the X/Y direction of the panel before it get picked it comes back on the same position.
unless i chance the rotation of the panel, that Will result in an total other end position.
I'm breaking mine mined on it, the calculated X and Y positions are looking good.
but a chance in rotation result in Strange things.
perhaps there is one of you that who has experience whit it.
is there something weird on mine procedure of calculation, my main question is how tho do the procedure proper.