Submit manuscript...
eISSN: 2574-8092

International Robotics & Automation Journal

Research Article Volume 7 Issue 3

A suggested simple design and inverse kinematics for a multi-degrees-of-freedom robot arm

Khaled MK Pasha

Department of Mechanics, Modern University, Egypt

Correspondence: Prof Khaled MK Pasha, Department of Mechanics, Modern University, Cairo, Egypt

Received: August 26, 2021 | Published: November 19, 2021

Citation: Pasha KMK. A suggested simple design and inverse kinematics for a multi-degrees-of-freedom robot arm. Int Rob Auto J. 2021;7(3):103-110. DOI: 10.15406/iratj.2021.07.00234

Download PDF

Abstract

In this paper, architecture for the robot arm and a mathematical model was suggested to simplify the inverse kinematics that describes the movement and orientation of this end-effector. Although this design contains eight degrees of freedom, all the angular displacements and velocities could be formulated as functions of the three coordinates of the end-effecter starting point. These three values are enough to set the end-effector at the desired point in the workspace, and with the desired orientation. The tip of the end-effecter could be equipped with a grabber or any attached manufacturing tool. To check the reliability of the introduced mathematical model, a simple model for the arm was built using aluminum beams. The joints are actuated by stepper motors that are controlled by a microprocessor. The model executed the positioning and orientation of the end-effector with an accuracy of about 93% of any traveled distance. This lack of accuracy may be accounted for by the low resolutions of the used motors. In this study, the positioning and orientation were only considered, and future work is required for the analysis of loads and power capacities

Keywords: inverse kinematics, arm, end-effector, 3-D

Introduction

In the last few decades, Robots moved from fantasy movies into real-world applications. Many amazing ideas for human-like robots appearing every day but, the robot arms attracted the engineer's attention for their wide range of applications in the manufacturing and other industrial requirements. Many factors must be carefully considered when designing a robot arm such as the geometry and size of the required workspace, the environmental conditions of its workspace (physical, thermal chemical …etc.). Between these various factors, the most challenging one is the inverse kinematics that relates the desired motion and orientation of the end-effector to its joint displacements.

Review of previous work

To achieve a successful robot arm design, it is mandatory to review the previous trials of the other researchers to make use of their advantages and to treat the gaps in their work. Some designers built their robots and depended on the sensors more than the calculations when moving the end-effector to the desired position. Glaufe et al.,1 developed a PID control system for a robotic arm with a computer vision system to capture objects. Its movements are limited to 6 possible positions depending on the color. Their lowest percentage of catches among all positions was 83.33%. Mohamed G et al.,2 used the topology optimization technique to obtain an optimal robot arm design from both structure and control viewpoints. They used (MMA) method as an optimization algorithm with a time-optimal control method to gain a design that ensures a minimum traveling time. They reported that the traveling time is reduced by 44.8%. Another category of the design concept is to control the robot arm by signals that transfer through the internet. Aishwarya et al.,3 tried to design autonomous robot systems wherein which, each device is uniquely identifiable by a controlling software which is the core concept of the Internet of Things. Their idea is to imitate the human hand movement with a virtually controlled robotic arm they used a video and audio interface plug-in to recognize audio commands and also video gestures. Sundari et al.,4 suggested a robotic arm using the Internet of things at a low cost. Their arm has controlled by a wireless technique by an authorized person at any time and from any place. They made a setup on the hardware side of their Robotic Arm to receive the client control signals. Swamardika et al.,5 designed a prototype of a mobile robot with an arm. They controlled it by wireless technology.

It has 6 wheels and 6 Degree of Freedom. The signals to this robot are sent serially via XBee transmitter and then, are processed on the receiver. Rajashekar et al.,6 designed a robot arm that is controlled by a remote user by an android application via a Bluetooth module connected to an Arduino and has 4 degrees of freedom. Rahman et al.,7 implemented and successfully tested an ASR K-250 robot that has 4 degrees of freedom arm. They considered the mechanical structure and construction of a humanoid robot arm without considering its dynamical analysis. The exact position and orientation of its arm depended on three joints. Ali et al.,8 introduced an idea for the design of the robot passive universal gripper that includes a mass of granular material enclosed in an elastic membrane. By the use of a combination of positive and negative pressure, the gripper can rapidly grip and release any item. This gripper passively takes the form of a target and the positive pressure reverses this action and enables a fast ejection of objects. Jadeja et al.,9 designed controlled a robotic arm by using Cortex ARM M3 LPC1768 Microcontroller. This arm has 5 Degrees of Freedom. It can work in hazardous circumstances and could be updated and modified easily. Their design could be modified in future work to be controlled by disabled people Jain et al.,10 modeled and analyzed an articulated robotic arm using Solid works and ANSYS software. Their structural analysis was successfully verified and they recommended the usage of their arm in the hazardous area in industries. Khosla et al.,11 tried to overcome the real-time problems in their designed robot. It is controlled by wireless communication with less hassle and with an easy-used GUI. It could distinguish the different objects and the way each one will be processed. Elfasakhany et al.,12 designed and implemented a robot arm with four degrees of freedom. Their arm could be integrated into a mobile platform in the industrial workforce. They equipped all servo motors with encoders to avoid the need to angle control. The inverse kinematic calculations and communications were done by Lab view connected serially to a microcontroller.

Bugday et al.,13 considered the required torques when the extending reach length and payload increase. They analyzed five different robotic arms and investigated the arm’s payload distribution. They changed Geometry and materials in alternative designs to minimize the redundant weight with the same positioning precision. They reported a 10% decrease in inert payloads. Reviewing the previous work mentioned above, we found that the majority of these trials depend on the control schemes rather than the inverse kinematics in positioning the arm and orienting the end- effecter. But other researchers had the same goals as that of the present work, for example; Clothier et al.,14 developed a geometric approach to estimate the joint angles for the arm positioning in the three-dimensional space. They used the trigonometric approach for the represented geometry of the arm. They tested their arm in a mobile robot platform. Their arm contained five degrees of freedom in addition to an end-effector. Oluwajobi et al.,15 designed and developed a 5-DoF (Degree of Freedom) robotic arm for educational purposes. They simulated the robotic arm by using the Matlab Robotics Toolbox, to visualize the joint movements and developed control software to control their robotic arm. This software can position the end-effector to any specified coordinates in space. Bi16 developed an optimized control algorithm containing a fuzzy algorithm based on the error rate adjustment P, I, D value model that depends on symmetry principles. For a two-degree-of-freedom (2-DOF) manipulator. He established a mathematical model of a 2-DOF which relates the input driving force and the output rotation angle. Next, he designed a set of trajectory planning algorithms by using gradient model control to predict the end-effector trajectory.

Objectives of the present work

From the review of the previous work, we observe that some designs are complicated and could be applied when certain conditions are available. In other designs, the motion depends mainly on sensing the environment. Other designs have low degrees of freedom but work according to complicated mathematics. In the present work, we suggest a simple robot arm design that has the following features;

  • Simple low-cost design
  • The grabber (or tool) of its end-effector can access any point in a spherical workspace whose center is
  • The origin of the base frame.
  • While the arm moves, it sweeps smaller volumes in the workspace to avoid collisions with obstacles.
  • It depends on simpler inverse kinematics in the positioning and orientation of its end-effector.

The suggested design

It is required to suggest a technique that can move the end-effector tool end-tip to a required position, (X, Y, Z), and rotate the tool to a required angle relative to the plane Y-Z. The designed arm executes this prescribed motion, through eight joints, and this is executed by estimating the angle values as functions of the coordinates, (X, Y, Z), of the tool end-tip of the end-effector. All the coordinates and angles are assigned relative to the base frame, (frame 0) Figures 1–5.

The suggested design can position the starting point of the end-effector, (the midpoint of the thickness of link L6 at joint ‘J6’, point ‘E’,) to a position that allows the tool end-tip to arrive at the required position with a predetermined inclination on the vertical plane, Y-Z. In future work, the design may be modified to allow the tool to be inclined on two planes with two predetermined angles. As illustrated in Figures 1– 4, the geometry could be described as follows; a fixed frame, (frame 0 of link 0) that carries link 1. Link 1 rotates about a vertical axis by joint J1and carries four identical links; L2, L3, L4, and L5). Between every two adjacent links, there is a revolute joint, joints J2, J3, J4, J5. The side of L2 is offset from the vertical axis of link 1 by a radius (r), Figure 4. A revolute joint, (J 5) connects L5 to L6. Another revolute joint, (J6) connects L6 to L7. The axes of joints J6 and J7 are mutually perpendicular. A prismatic joint, J8, connects L7 to L8, which may be a grabber mechanism or a manufacturing tool. If it is equipped with grabbers, these grabbers are operated by a gearing system, Figure 6. The prismatic joint is useful when there are space constraints around the goal. Also, it is useful in case, if it is desired to access the narrow region of the corner between the ground and link 1. All the revolute and prismatic joints are shown in Figures 2,3,6 and they are actuated by servo DC motors. The suggested arm can access any point, (x, y, z), in a spherical region whose center, (O), is the intersection of the axes of frame ‘0’, or frame ‘1’. The only region that is inaccessible is the volume occupied by the link L1 which is defined by (x2+y2w, and z > t/2  and ), where‘t’ is the thickness of any one of the links, (L2-L6). Figure 7 illustrates the different positions in the workspace of the arm.

Figure 1 Defining the position of the point, (E), (mid-point of joint J6) in frame 0.

Figure 2 The main features and dimensions, (in cm) of the arm installation.

Figure 3 The orientations of the arm links when it is contracted.

Figure 4 A top views for the arm before and after motion.

Figure 5 Illustration of the arm after rotating link 1 by an angle θnet and link 2 by angle β.

Figure 6 Details of the grabber configuration, links (6 to 8).

Figure 7 The different positions in the workspace of the arm.

The inverse kinematics equations

The technique of positioning and orientation of the end-effector depends on the transformation of the Cartesian coordinates into spherical coordinates then, we can deduce the joints displacements. To make the following analysis more clear, we first consider the arm when it is stretched to its maximum length, (and lies in the plane X-Y), and draw an imaginary rectangle, (O a E b) as shown in Figure 4. Its length (Oa) equals the sum of lengths of links (2 to 5) and its width equals the width of the four links, (L2, L3, L4, and L5), plus the radius of link L1 and half the width of link L6, Figures 3–5. The axis of joint 1 passes by the origin of frame 1 which coincide with the origin of frame ‘0’ and the position of the midpoint of the thickness of link L6 at joint ‘J6’, (point ‘E’), is defined in frame ‘0’ by the coordinates, (XE, YE, ZE).

Notes

  1. (E) Is the origin of frame 6?
  2. To rotate the end-effector tool, (L7+L8), at the desired angle, τ, with plane Y-Z, it is easier to keep link 6 in a horizontal position; that means after rotating links L2, L3, L4, and L5, link L6 should rotate at an angle –(β)
  3. θnet is the rotation angle of the joint (J1) relative to plane Y-Z
  4. θ p MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXLqbaoaaBaaaleaajugWaiablIHiVbWcbeaajugibiaadchaaaa@4023@ is between (O EP) and ( O aP), Figure 5
  5. According to equation (4) θ p MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXLqbaoaaBaaaleaajugWaiablIHiVbWcbeaajugibiaadchaaaa@4023@ has always a positive value
  6. β is the rotation angle of joint (J2) relative to plane X-Y
  7. α, Figure 3, is the angle between any one of links L2, L3, L4, and L5 relative to the imaginary rectangle (O a E b), Figures 3,4.
  8. The rectangle (O ap E bp) is the projected view of the rectangle (O a E b) on the X-Y plane
  9. To ensure that, the angle of inclination between the end-effector and the Y-Z plane equals (τ), joint J7 should rotate by a value that equals  ( θ net +τ ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaqada GcbaqcLbsacqGHsislcqaH4oqClmaaBaaabaqcLbmacaWGUbGaamyz aiaadshaaSqabaqcLbsacqGHRaWkcqaHepaDaOGaayjkaiaawMcaaa aa@45FB@
  10. Before the first arm movement, the initial directions of links, L2, L3, L4, L5, and L6 are vertical, (parallel to Z-axis).

Now, consider the case when we need to position the tool end-tip at a predetermined point, (X, Y, Z) such that, the end-effector tool should make the desired angle, (τ), with the plane Y-Z. Reviewing Figures 3–5; the controller will rotate link 1 by an angle (θnet) and rotate the link 2 by an angle (β). Finally, the total arm length should be reduced to the length (O a) by rotating joint, J2, again by an angle ( α 90 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeg 7aHjabgkHiTiaaiMdacaaIWaWcdaahaaqcfayabeaajugWaiablIHi Vbaaaaa@40E8@ ) and rotating joints J3, J4, and J5 by angle values, ( 180 ° 2α MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaaig dacaaI4aGaaGimaSWaaWbaaeqabaqcLbmacqGHWcaSaaqcLbsacqGH sislcaaIYaGaeqySdegaaa@4311@ ), ( 2α 180 ° MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaaik dacqaHXoqycqGHsislcaaIXaGaaGioaiaaicdalmaaCaaabeqaaKqz adGaeyiSaalaaaaa@4282@ ), and ( ( 180 ° 2α ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaqada qaaKqzGeGaaGymaiaaiIdacaaIWaWcdaahaaqcfayabeaajugWaiab gclaWcaajugibiabgkHiTiaaikdacqaHXoqyaKqbakaawIcacaGLPa aaaaa@4644@ ), respectively. Joint J6 rotates by an angle – ( 90 o +β ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaqada GcbaqcLbsaqaaaaaaaaaWdbiaaiMdacaaIWaWcpaWaaWbaaeqabaqc LbmapeGaam4Baaaajugib8aacqGHRaWkcqaHYoGyaOGaayjkaiaawM caaaaa@4313@ to stay in a horizontal position, as mentioned before. These movements will allow point (E) to arrive at position (XE, YE, ZE) which is related to the required position (X, Y, Z) as will be shown in the following section.

The relations between the tool end-tip destination, (X, Y, Z) and ( θ net ,β,α MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXTWaaSbaaeaajugWaiaad6gacaWGLbGaamiDaaWcbeaajugibiaa cYcacqaHYoGycaGGSaGaeqySdegaaa@44DC@ )

After executing any movement, (except the special positions that will be explained later), the link L6 will be horizontal, and the end-effector tool, (L7+L8), should make a predefined angle, (τ), with Y-Z plane where,

( 90 <=τ<= 90 ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaqada qaaKqzGeGaeyOeI0IaaGyoaiaaicdalmaaCaaajuaGbeqaaKqzadGa eSigI8gaaKqzGeGaeyipaWJaeyypa0JaeqiXdqNaeyipaWJaeyypa0 JaaGyoaiaaicdalmaaCaaajuaGbeqaaKqzadGaeSigI8gaaaqcfaOa ayjkaiaawMcaaaaa@4CF6@  following the angle sign convention;

X E =X+L6sin( θ net )+(L7+L8)sin(τ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaadI falmaaBaaabaqcLbmacaWGfbaaleqaaKqzGeGaeyypa0Jaamiwaiab gUcaRiaadYeacaaI2aGaci4CaiaacMgacaGGUbGaaiikaiabeI7aXT WaaSbaaeaajugWaiaad6gacaWGLbGaamiDaaWcbeaajugibiaacMca cqGHRaWkcaGGOaGaamitaiaaiEdacqGHRaWkcaWGmbGaaGioaiaacM caciGGZbGaaiyAaiaac6gacaGGOaGaeqiXdqNaaiykaaaa@5896@   (1a)

Y E =YL6cos( θ net )(L7+L8)cos(τ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaadM fajuaGdaWgaaWcbaqcLbmacaWGfbaaleqaaKqzGeGaeyypa0Jaamyw aiabgkHiTiaadYeacaaI2aGaci4yaiaac+gacaGGZbGaaiikaiabeI 7aXTWaaSbaaeaajugWaiaad6gacaWGLbGaamiDaaWcbeaajugibiaa cMcacqGHsislcaGGOaGaamitaiaaiEdacqGHRaWkcaWGmbGaaGioai aacMcaciGGJbGaai4BaiaacohacaGGOaGaeqiXdqNaaiykaaaa@5932@   (1b)

Z E =Z MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaadQ fajuaGdaWgaaWcbaqcLbmacaWGfbaaleqaaKqzGeGaeyypa0JaamOw aaaa@3FCC@   (1c)

The length of OE defined in frame 0 is;

OE= X E 2 + Y E 2 + Z E 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaad+ eacaWGfbGaeyypa0tcfa4aaOaaaOqaaKqzGeGaamiwaSWaa0baaeaa jugWaiaadweaaSqaaKqzadGaaGOmaaaajugibiabgUcaRiaadMfalm aaDaaabaqcLbmacaWGfbaaleaajugWaiaaikdaaaqcLbsacqGHRaWk caWGAbWcdaqhaaqaaKqzadGaamyraaWcbaqcLbmacaaIYaaaaaWcbe aaaaa@4F6C@   (2)

To estimate the first required angle, θ net MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXLqbaoaaBaaaleaajugWaiaad6gacaWGLbGaamiDaaWcbeaaaaa@403B@ for any position of the end-effector (E), we notice from the situation shown in Figure 4 that, according to the sign conventions, θ net MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXLqbaoaaBaaaleaajugWaiaad6gacaWGLbGaamiDaaWcbeaaaaa@403B@ is negative, θ MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXbaa@3B72@ is positive, and θ p MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXLqbaoaaBaaaleaajugWaiablIHiVjaadchaaSqabaaaaa@3F94@ is positive;

θ net =θ+ θ p π 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXTWaaSbaaKqbagaajugWaiaad6gacaWGLbGaamiDaaqcfayabaqc LbsacqGH9aqpcqaH4oqCcqGHRaWkcqaH4oqClmaaBaaajuaGbaqcLb macqWIyiYBcaWGWbaajuaGbeaajugibiabgkHiTKqbaoaalaaabaqc LbsacqaHapaCaKqbagaajugibiaaikdaaaaaaa@5185@   (3)

θ p = sin 1 ( W O E p ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXLqbaoaaBaaaleaajugWaiablIHiVjaadchaaSqabaqcLbsacqGH 9aqpciGGZbGaaiyAaiaac6galmaaCaaabeqaaKqzadGaeyOeI0IaaG ymaaaajuaGdaqadaGcbaqcfa4aaSaaaOqaaKqzGeGaam4vaaGcbaqc LbsacaWGpbGaamyraKqbaoaaBaaaleaajugWaiaadchaaSqabaaaaa GccaGLOaGaayzkaaaaaa@5061@   (4)

θ ° =co s 1 ( W O E p ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXLqbaoaaBaaaleaajugibiabgclaWcWcbeaajugibiabg2da9iaa cogacaGGVbGaai4CaSWaaWbaaeqabaqcLbmacqGHsislcaaIXaaaaK qbaoaabmaakeaajuaGdaWcaaGcbaqcLbsacaWGxbaakeaajugibiaa d+eacaWGfbWcdaWgaaqaaKqzadGaamiCaaWcbeaaaaaakiaawIcaca GLPaaaaaa@4EEA@   (5)

O E p = x E 2 + y E 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaad+ eacaWGfbWcdaWgaaqaaKqzadGaamiCaaWcbeaajugibiabg2da9Kqb aoaakaaakeaajugibiaadIhalmaaDaaabaqcLbmacaWGfbaaleaaju gWaiaaikdaaaqcLbsacqGHRaWkcaWG5bWcdaqhaaqaaKqzadGaamyr aaWcbaqcLbmacaaIYaaaaaWcbeaaaaa@4C2B@   (6)

θ= cos 1 ( X E O E p ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXjabg2da9iGacogacaGGVbGaai4CaSWaaWbaaeqabaqcLbmacqGH sislcaaIXaaaaKqbaoaabmaakeaajuaGdaWcaaGcbaqcLbsacaWGyb qcfa4aaSbaaSqaaKqzGeGaamyraaWcbeaaaOqaaKqzGeGaam4taiaa dweajuaGdaWgaaWcbaqcLbmacaWGWbaaleqaaaaaaOGaayjkaiaawM caaaaa@4DCA@   (7)

O a p =O E p cos( θ ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaad+ eacaWGHbWcdaWgaaqaaKqzadGaamiCaaWcbeaajugibiabg2da9iaa d+eacaWGfbWcdaWgaaqcfayaaKqzadGaamiCaaqcfayabaqcLbsaci GGJbGaai4BaiaacohajuaGdaqadaGcbaqcLbsacqaH4oqClmaaBaaa baqcLbmacqWIyiYBaSqabaaakiaawIcacaGLPaaaaaa@4EDF@   (8)

The joint, J2, will first, rotate at an angle, 0<β 90 ° MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaaic dacqGH8aapcqaHYoGycqGHKjYOcaaI5aGaaGimaSWaaWbaaeqabaqc LbmacqGHWcaSaaaaaa@4394@ , which is calculated from;

β= sin 1 ( Z E Oa ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabek 7aIjabg2da9iGacohacaGGPbGaaiOBaSWaaWbaaeqabaqcLbmacqGH sislcaaIXaaaaKqbaoaabmaakeaajuaGdaWcaaGcbaqcLbsacaWGAb qcfa4aaSbaaSqaaKqzadGaamyraaWcbeaaaOqaaKqzGeGaam4taiaa dggaaaaakiaawIcacaGLPaaaaaa@4B8F@   (9)

O a p =O a p cos( β ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaad+ eacaWGHbWcdaWgaaqaaKqzadGaamiCaaWcbeaajugibiabg2da9iaa d+eacaWGHbWcdaWgaaqaaKqzadGaamiCaaWcbeaajugibiGacogaca GGVbGaai4CaKqbaoaabmaakeaajugibiabek7aIbGccaGLOaGaayzk aaaaaa@4B36@   (10)

When the arms contracts to length (O a), α is estimated from;

α= cos 1 ( O a 4m ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeg 7aHjabg2da9iGacogacaGGVbGaai4CaSWaaWbaaKqbagqabaqcLbma cqGHsislcaaIXaaaaKqbaoaabmaabaWaaSaaaeaajugibiaad+eaju aGdaWgaaqaaKqzadGaamyyaaqcfayabaaabaqcLbsacaaI0aGaamyB aaaaaKqbakaawIcacaGLPaaaaaa@4C6D@   (11)

Notes

  1. 0< θ net <2π MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaaic dacqGH8aapcqaH4oqClmaaBaaabaqcLbmacaWGUbGaamyzaiaadsha aSqabaqcLbsacqGH8aapcaaIYaGaeqiWdahaaa@4577@
  2. π 2 <β< π 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaWcca GcbaqcLbsacqaHapaCaOqaaKqzGeGaaGOmaaaacqGH8aapcqaHYoGy cqGH8aapjuaGdaWccaGcbaqcLbsacqaHapaCaOqaaKqzGeGaaGOmaa aaaaa@456C@
  3. 0<α< π 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaaic dacqGH8aapcqaHXoqycqGH8aapjuaGdaWcaaqaaKqzGeGaeqiWdaha juaGbaqcLbsacaaIYaaaaaaa@42E0@
  4. Joint 2, first, rotates by an angle β, then, rotates by an angle α, but the other three joints, 3 to 5rotate at angles that equal +2α, -2α, and +2α, respectively, as seen from Figure 3.
  5. The old values of (θnet, β and α) are subtracted from the newly calculated values to get the corresponding net values which will be executed by the actuators.

The speeds of joints

Now, if the motion of point (E) is prescribed by ( X E . , Y E . , Z E . ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaqada GcbaqcLbsacaWGybWcdaqhaaqaaKqzadGaamyraaWcbaqcLbmacaGG UaaaaKqzGeGaaiilaiaadMfalmaaDaaabaqcLbmacaWGfbaaleaaju gWaiaac6caaaqcLbsacaGGSaGaamOwaSWaa0baaeaajugWaiaadwea aSqaaKqzadGaaiOlaaaaaOGaayjkaiaawMcaaaaa@4D2F@ then, the corresponding speeds of (θnet, β and α) are estimated as follows;

From equation (2);

OE= ( X E 2 + Y E 2 + Z E 2 ) 0.5 ( X E X E . + Y E Y E . + Z E Z E . ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaad+ eacaWGfbGaeyypa0tcfa4aaeWaaeaajugibiaadIfalmaaDaaajuaG baqcLbmacaWGfbaajuaGbaqcLbmacaaIYaaaaKqzGeGaey4kaSIaam ywaSWaa0baaKqbagaajugWaiaadweaaKqbagaajugWaiaaikdaaaqc LbsacqGHRaWkcaWGAbWcdaqhaaqcfayaaKqzadGaamyraaqcfayaaK qzadGaaGOmaaaaaKqbakaawIcacaGLPaaadaahaaqabeaajugWaiab gkHiTiaaicdacaGGUaGaaGynaaaajuaGdaqadaqaaKqzGeGaamiwaS WaaSbaaKqbagaajugWaiaadweaaKqbagqaaKqzGeGaamiwaSWaa0ba aKqbagaajugWaiaadweaaKqbagaajugWaiaac6caaaqcLbsacqGHRa WkcaWGzbWcdaWgaaqcfayaaKqzadGaamyraaqcfayabaqcLbsacaWG zbWcdaqhaaqcfayaaKqzadGaamyraaqcfayaaKqzadGaaiOlaaaaju gibiabgUcaRiaadQfajuaGdaWgaaqaaKqzadGaamyraaqcfayabaqc LbsacaWGAbWcdaqhaaqcfayaaKqzadGaamyraaqcfayaaKqzadGaai OlaaaaaKqbakaawIcacaGLPaaaaaa@7F08@   (12)

From equation (6);

O E P = ( X E 2 + Y E 2 ) 0.5 ( X E X E . + Y E Y E . ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaad+ eacaWGfbqcfa4aaSbaaSqaaKqzadGaamiuaaWcbeaajugibiabg2da 9KqbaoaabmaakeaajugibiaadIfalmaaDaaabaqcLbmacaWGfbaale aajugWaiaaikdaaaqcLbsacqGHRaWkcaWGzbWcdaqhaaqaaKqzadGa amyraaWcbaqcLbmacaaIYaaaaaGccaGLOaGaayzkaaWcdaahaaqabe aajugWaiabgkHiTiaaicdacaGGUaGaaGynaaaajuaGdaqadaGcbaqc LbsacaWGybWcdaWgaaqaaKqzadGaamyraaWcbeaajugibiaadIfalm aaDaaabaqcLbmacaWGfbaaleaajugWaiaac6caaaqcLbsacqGHRaWk caWGzbWcdaWgaaqaaKqzadGaamyraaWcbeaajugibiaadMfalmaaDa aabaqcLbmacaWGfbaaleaajugWaiaac6caaaaakiaawIcacaGLPaaa aaa@6781@   (13)

From equation (4)

θ °p . = 1 cos θ °p ( O E p . w ( O E p ) 2 ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXTWaa0baaKqbagaajugWaiabgclaWkaadchaaKqbagaajugWaiaa c6caaaqcLbsacqGH9aqpcqGHsisljuaGdaWcaaGcbaqcLbsacaaIXa aakeaajugibiGacogacaGGVbGaai4CaiabeI7aXTWaaSbaaeaajugW aiabgclaWkaadchaaSqabaaaaKqbaoaabmaakeaajuaGdaWcaaGcba qcLbsacaWGpbGaamyraSWaa0baaeaajugWaiaadchaaSqaaKqzadGa aiOlaaaajugibiaadEhaaOqaaKqbaoaabmaakeaajugibiaad+eaca WGfbWcdaWgaaqaaKqzadGaamiCaaWcbeaaaOGaayjkaiaawMcaaSWa aWbaaeqabaqcLbmacaaIYaaaaaaaaOGaayjkaiaawMcaaaaa@641F@   (14)

From equation (7);

θ . = ( O E p )( X E . )( X E )( O E p . ) ( sinθ ) ( O E p ) 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaWfGa GcbaqcLbsacqaH4oqCaSqabeaajugWaiaac6caaaqcLbsacqGH9aqp cqGHsisljuaGdaWcaaGcbaqcfa4aaeWaaOqaaKqzGeGaam4taiaadw ealmaaBaaabaqcLbmacaWGWbaaleqaaaGccaGLOaGaayzkaaqcfa4a aeWaaOqaaKqzGeGaamiwaSWaa0baaeaajugWaiaadweaaSqaaKqzad GaaiOlaaaaaOGaayjkaiaawMcaaKqzGeGaeyOeI0scfa4aaeWaaOqa aKqzGeGaamiwaKqbaoaaBaaaleaajugWaiaadweaaSqabaaakiaawI cacaGLPaaajuaGdaqadaGcbaqcLbsacaWGpbqcfa4aaCbiaOqaaKqz GeGaamyraKqbaoaaBaaaleaajugWaiaadchaaSqabaaabeqaaKqzad GaaiOlaaaaaOGaayjkaiaawMcaaaqaaKqbaoaabmaakeaajugibiGa cohacaGGPbGaaiOBaiabeI7aXbGccaGLOaGaayzkaaqcfa4aaeWaaO qaaKqzGeGaam4taiaadweajuaGdaWgaaWcbaqcLbmacaWGWbaaleqa aaGccaGLOaGaayzkaaqcfa4aaWbaaSqabeaajugWaiaaikdaaaaaaa aa@7338@   (15)

To estimate θnet from equation (3);

θ net . = θ p . + θ °p . MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXTWaa0baaeaajugWaiaad6gacaWGLbGaamiDaaWcbaqcLbmacaGG UaaaaKqzGeGaeyypa0JaeqiUde3cdaqhaaqaaKqzadGaamiCaaWcba qcLbmacaGGUaaaaKqzGeGaey4kaSIaeqiUde3cdaqhaaqaaKqzadGa eyiSaaRaamiCaaWcbaqcLbmacaGGUaaaaaaa@5262@   (16)

From equations (8);

O . a=( OE )( sin θ ° ) θ . ° +( cos θ ° )( OE . ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaWfGa GcbaqcLbsacaWGpbaaleqabaqcLbmacaGGUaaaaKqzGeGaamyyaiab g2da9iabgkHiTKqbaoaabmaakeaajugibiaad+eacaWGfbaakiaawI cacaGLPaaajuaGdaqadaGcbaqcLbsaciGGZbGaaiyAaiaac6gacqaH 4oqClmaaBaaabaqcLbmacqGHWcaSaSqabaaakiaawIcacaGLPaaaju aGdaWfGaGcbaqcLbsacqaH4oqCaSqabeaajugWaiaac6caaaqcfa4a aSbaaSqaaKqzadGaeyiSaalaleqaaKqzGeGaey4kaSscfa4aaeWaaO qaaKqzGeGaci4yaiaac+gacaGGZbGaeqiUdexcfa4aaSbaaSqaaKqz adGaeyiSaalaleqaaaGccaGLOaGaayzkaaqcfa4aaeWaaOqaaKqbao aaxacakeaajugibiaad+eacaWGfbaaleqabaqcLbmacaGGUaaaaaGc caGLOaGaayzkaaaaaa@6C3B@   (17)

From equations (9);

β . = ( Oa )( z E . )( z E )( Oa . ) ( cosβ ) ( Oa ) 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaWfGa GcbaqcLbsacqaHYoGyaSqabeaajugWaiaac6caaaqcLbsacqGH9aqp juaGdaWcaaGcbaqcfa4aaeWaaOqaaKqzGeGaam4taiaadggaaOGaay jkaiaawMcaaKqbaoaabmaakeaajugibiaadQhalmaaDaaabaqcLbma caWGfbaaleaajugWaiaac6caaaaakiaawIcacaGLPaaajugibiabgk HiTKqbaoaabmaakeaajugibiaadQhajuaGdaWgaaWcbaqcLbsacaWG fbaaleqaaaGccaGLOaGaayzkaaqcfa4aaeWaaOqaaKqbaoaaxacake aajugibiaad+eacaWGHbaaleqabaqcLbmacaGGUaaaaaGccaGLOaGa ayzkaaaabaqcfa4aaeWaaOqaaKqzGeGaci4yaiaac+gacaGGZbGaeq OSdigakiaawIcacaGLPaaajuaGdaqadaGcbaqcLbsacaWGpbGaamyy aaGccaGLOaGaayzkaaqcfa4aaWbaaSqabeaajugWaiaaikdaaaaaaa aa@6967@   (18)

From equation (11);

α= ( O . a ) sin( α )4m MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeg 7aHjabg2da9iabgkHiTKqbaoaalaaakeaajuaGdaqadaGcbaqcfa4a aCbiaOqaaKqzGeGaam4taaWcbeqaaKqzadGaaiOlaaaajugibiaadg gaaOGaayjkaiaawMcaaaqaaKqzGeGaci4CaiaacMgacaGGUbqcfa4a aeWaaOqaaKqzGeGaeqySdegakiaawIcacaGLPaaajugibiaaisdaca WGTbaaaaaa@4FB9@   (19)

Special regions

Before operating the arm, all angles (θnet, β α and ε MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabew 7aLbaa@3B63@ ) are set at zero values

  1. When the controller is fed by position coordinates that satisfy the conditions

(x2+y2w, and z > t/2), Figure 8a, the following control process is accomplished to settle the grabber or the tool end-tip at this point;

  1. Link 1 rotates by an angle θ net = tan 1 ( Y/X ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXTWaaSbaaeaajugWaiaad6gacaWGLbGaamiDaaWcbeaajugibiab g2da9iabgkHiTiGacshacaGGHbGaaiOBaSWaaWbaaeqabaqcLbmacq GHsislcaaIXaaaaKqbaoaabmaakeaajuaGdaWcgaGcbaqcLbsacaWG zbaakeaajugibiaadIfaaaaakiaawIcacaGLPaaaaaa@4DBF@
  2. Next, Link 2 first, will rotate by an angle β= 90 ° MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabek 7aIjabg2da9iaaiMdacaaIWaWcdaahaaqabeaajugWaiabgclaWcaa aaa@4127@
  3. Links (2 to 6) will rotate by angle values that equal (90 α ° ),2 ( 90α ) ° ,2 ( 90α ) ° ,2( 90α ),and( 180α ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaacI cacaaI5aGaaGimaiabgkHiTiabeg7aHTWaaWbaaeqabaqcLbmacqGH WcaSaaWccaGGPaGaaiilaKqzGeGaaGOmaKqbaoaabmaakeaajugibi aaiMdacaaIWaGaeyOeI0IaeqySdegakiaawIcacaGLPaaalmaaCaaa juaGbeqaaKqzadGaeyiSaalaaSGaaiilaKqzGeGaeyOeI0IaaGOmaK qbaoaabmaakeaajugibiaaiMdacaaIWaGaeyOeI0IaeqySdegakiaa wIcacaGLPaaalmaaCaaajuaGbeqaaKqzadGaeyiSaalaaSGaaiilaK qzGeGaaGOmaKqbaoaabmaakeaajugibiaaiMdacaaIWaGaeyOeI0Ia eqySdegakiaawIcacaGLPaaajuaGcaGGSaGaamyyaiaad6gacaWGKb WaaeWaaOqaaKqzGeGaaGymaiaaiIdacaaIWaGaeyOeI0IaeqySdega kiaawIcacaGLPaaaaaa@7046@ respectively, where,

α= cos 1 ( zL6zz 4m ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeg 7aHjabg2da9iGacogacaGGVbGaai4CaSWaaWbaaeqabaqcLbmacqGH sislcaaIXaaaaKqbaoaabmaakeaajuaGdaWcaaGcbaqcLbsacaWG6b GaeyOeI0IaamitaiaaiAdacqGHsislcaWG6bGaamOEaaGcbaqcLbsa caaI0aGaamyBaaaaaOGaayjkaiaawMcaaaaa@4E4A@   (20)

where;

zz= ( L7+L8 ) 2 ( wxy ) 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaadQ hacaWG6bGaeyypa0tcfa4aaOaaaOqaaKqbaoaabmaakeaajugibiaa dYeacaaI3aGaey4kaSIaamitaiaaiIdaaOGaayjkaiaawMcaaSWaaW baaeqabaqcLbmacaaIYaaaaKqzGeGaeyOeI0scfa4aaeWaaOqaaKqz GeGaam4DaiabgkHiTiaadIhacaWG5baakiaawIcacaGLPaaalmaaCa aabeqaaKqzadGaaGOmaaaaaSqabaaaaa@507C@   (21)

xy= x 2 + y 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaadI hacaWG5bGaeyypa0tcfa4aaOaaaeaajugibiaadIhajuaGdaahaaqa beaajugWaiaaikdaaaqcLbsacqGHRaWkcaWG5bqcfa4aaWbaaeqaba qcLbmacaaIYaaaaaqcfayabaaaaa@4718@   (22)

  1. Finally, link 7 rotates by an angle that equals [ tan 1 ( wxy zz ) ] MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaWada GcbaqcLbsaciGG0bGaaiyyaiaac6galmaaCaaabeqaaKqzadGaeyOe I0IaaGymaaaajuaGdaqadaGcbaqcfa4aaSaaaOqaaKqzGeGaam4Dai abgkHiTiaadIhacaWG5baakeaajugibiaadQhacaWG6baaaaGccaGL OaGaayzkaaaacaGLBbGaayzxaaaaaa@4BF7@
  1. When the controller is fed by position coordinates that satisfy the conditions

(x2+y2w, and z < -t/2), Figure 8b, the following procedure is followed;

  1. Link 1 rotates by an angle θ net = tan 1 ( Y/X ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeI 7aXTWaaSbaaeaajugWaiaad6gacaWGLbGaamiDaaWcbeaajugibiab g2da9iabgkHiTiGacshacaGGHbGaaiOBaSWaaWbaaeqabaqcLbmacq GHsislcaaIXaaaaKqbaoaabmaakeaajuaGdaWcgaGcbaqcLbsacaWG zbaakeaajugibiaadIfaaaaakiaawIcacaGLPaaaaaa@4DBF@
  2. Next, Link 2 first, will rotate by an angle β= 90 ° MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabek 7aIjabg2da9iabgkHiTiaaiMdacaaIWaWcdaahaaqabeaajugWaiab gclaWcaaaaa@4214@
  3. Links (2 to 6) will rotate by angle values that equal ( 90 α ),2 ( 90α ) ° ,2 ( 90α ) ° ,2( 90α )and( 180α ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaqada GcbaqcLbsacaaI5aGaaGimaiabgkHiTiabeg7aHTWaaWbaaeqabaqc LbmacqWIyiYBaaaakiaawIcacaGLPaaajuaGcaGGSaqcLbsacaaIYa qcfa4aaeWaaOqaaKqzGeGaaGyoaiaaicdacqGHsislcqaHXoqyaOGa ayjkaiaawMcaaSWaaWbaaKqbagqabaqcLbmacqGHWcaSaaWccaGGSa qcLbsacqGHsislcaaIYaqcfa4aaeWaaOqaaKqzGeGaaGyoaiaaicda cqGHsislcqaHXoqyaOGaayjkaiaawMcaaSWaaWbaaKqbagqabaqcLb macqGHWcaSaaWccaGGSaqcLbsacaaIYaqcfa4aaeWaaOqaaKqzGeGa aGyoaiaaicdacqGHsislcqaHXoqyaOGaayjkaiaawMcaaKqbakaadg gacaWGUbGaamizamaabmaakeaajugibiaaigdacaaI4aGaaGimaiab gkHiTiabeg7aHbGccaGLOaGaayzkaaaaaa@7039@ respectively, where,

α= 180 ° cos 1 ( z+L6+zz 4m ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabeg 7aHjabg2da9iaaigdacaaI4aGaaGimaSWaaWbaaeqabaqcLbmacqGH WcaSaaqcLbsacqGHsislciGGJbGaai4BaiaacohalmaaCaaabeqaaK qzadGaeyOeI0IaaGymaaaajuaGdaqadaGcbaqcfa4aaSaaaOqaaKqz GeGaamOEaiabgUcaRiaadYeacaaI2aGaey4kaSIaamOEaiaadQhaaO qaaKqzGeGaaGinaiaad2gaaaaakiaawIcacaGLPaaaaaa@552E@   (23)

Figure 8 Positioning the tool end-tip at a point (x, y, z);
a) (x2+y2w, and z > t/2)
b) (x2+y2w, and z < -t/2)
c) Singularity region when the controller is fed by position coordinates that satisfy the conditions (x=y=0, and z > t/2), Link 2 first, will rotate by an angle β=90℃. Next, steps (c) and (d) of case (1) are followed, (in this case xy =0).

  1. Finally, link 7 rotates by an angle, ε MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabew 7aLbaa@3B63@ , where

ε= tan 1 ( zz wxy ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabew 7aLjabg2da9iGacshacaGGHbGaaiOBaKqbaoaaCaaabeqaaKqzadGa eyOeI0IaaGymaaaajuaGdaqadaqaamaalaaabaqcLbsacaWG6bGaam OEaaqcfayaaKqzGeGaam4DaiabgkHiTiaadIhacaWG5baaaaqcfaOa ayjkaiaawMcaaaaa@4D03@   (24)

Notes

  • For this case, ( x 2 + y 2 >r ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaqada qaamaakaaabaqcLbsacaWG4bWcdaahaaqcfayabeaajugWaiaaikda aaqcLbsacqGHRaWkcaWG5bWcdaahaaqcfayabeaajugWaiaaikdaaa aajuaGbeaajugibiabg6da+iaadkhaaKqbakaawIcacaGLPaaaaaa@4843@ where ‘r’ is the radius of link L1
  • zz is calculated from Equation (21).
  • And again, the executed values of (θnet, β α and ε MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabew 7aLbaa@3B63@ ) are the differences between the newly
  • Calculated values and the old values.

Dealing with obstacles

In many applications, the workspace is expected to contain some obstacles, and so, each one of the links, L2, L3, L4, L5, L6, and L7 is equipped with a proximity sensor. If an obstacle is detected by one of the sensors attached to (L2-L5), the controller, first, stops the arm and stores the current values of ( α, θ and β) and tries to avoid the arm obstacle as follows;

  1. To rotate the joints J2, J3, J4, J5, and J6 with new values that equal the old values as shown in Figure 9, case (1), but with reversed signs as shown in case (2)
  2. If the obstacle is still detected by any of the sensors of L3 or L4, joints J3, J4, and J5 will rotate by values, 2α and -4α, respectively. Figure 9, cases (3), and (4).
  3. During the rotation of joint J1, if the obstacle is detected by any of the sensors, (L6 and L7), the arm stops, and joint J2 keeps rotating with a positive value until the sensors miss the obstacle. Next, J2 stops and the controller stores the swept angle of J2, and joint J1 is rotated by the predetermined value, (θnet), and then, J2 is again rotated by the stored value but in the reversed direction.
  4. In case (3), if J2 is rotated by the maximum angle value and the obstacle could not be missed, J2 rotates in the opposite direction by the same angle value and keeps rotating until the sensors miss the obstacle and continue the described procedure.
  5. If the obstacle is detected by any of the sensors (L6 and L7) during the rotation of joint J2 the same procedure that is described in (3) and (4) is followed but with swapping the roles of the joints J1 and J2.
  6. If the obstacle is still detected by any of the sensors of (L2- L7), joint J2 will rotate by a value that equals (- the current value of θ) - 2π θ net MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaaik dacqaHapaCcqGHsislcqaH4oqClmaaBaaabaqcLbmacaWGUbGaamyz aiaadshaaSqabaaaaa@4313@
  7. If the obstacle is still detected by any of the sensors of (L2- L7), joint J1 will rotate by a value that equals (- the current value of β) - 2πβ MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiaaik dacqaHapaCcqGHsislcqaHYoGyaaa@3EC3@
  8. If the obstacle is still detected by any of the sensors of (L2 – L7), the arm returns to the initial position, and then, the sequence of the executions of the three angles, are changed, (β θ, and α), (α, β, θ and )… etc. until no obstacle is detected.

Figure 9 Two trials of avoiding an obstacle.

In all the above cases, the executed angle values are the differences between the new values and the stored values.

Simple model

To test the suggested technique, a simple model is built according to the details shown in Figures 2–4,6 by using an aluminum alloy. From the figures, it is obvious that we need to connect many wires to supply the different actuators with power and control signals. It is important to pass these wires in paths that save them from damages by rubbing, collisions, or hanging with any entities during the arm motion. Also, these paths should not hinder the arm motion. One suggestion is to pass the wires inside the links and through the links axles as shown in Figure 10. From the figure, it is observed that there is excessive wire length to allow the expected wire pulling during the links rotations. This suggested path is applied to joints, J2- to J6 only, but the expected movements of joint J7 will not be hindered by the wires if they were without isolating path. Since the maximum expected rotation angle for any link is less than 180, the maximum excess in the wire length must be larger than (N x π 2 MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajuaGdaWcca qaaKqzGeGaeqiWdahajuaGbaqcLbsacaaIYaaaaaaa@3DF2@ x d), where, ‘N’ is the number of considered joints, (5 in this case) and ‘d’ is the joint axle radius plus the wire bundle diameter. Also, the top surfaces of the hollow axles are removed, and a suitable number of openings are cut in each arm to facilitate the wire passing process. The axle holes' positions and diameters are carefully chosen with suitable lubricants that ensure fluent wire sliding.

Figure 10 The suggested wire bundle passage.

To check the suggested design, the following procedure is repeated for different specified positions;

– Feed the controller with the coordinates of the required position for the tool end-tip, and its angle of inclination on the X-Y plane.

– A manual 3-D traverse mechanism is adjusted to position a small needle tip at the required destination point.

– Execute the arm movement.

– Alter the traverse mechanism to position the needle tip at the tool end-tip.

– Register the differences in coordinates of the required and actual positions of the tool end-tip

– To measure the percentage of deviation in the inclination angle of the end-effector, Δτ MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabfs 5aejabes8a0baa@3CE7@ %, we position the needle tip at the tool end-tip and joint J6, and from the differences in its coordinates we calculate the actual inclination angle, τ actual MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabes 8a0TWaaSbaaeaajugWaiaadggacaWGJbGaamiDaiaadwhacaWGHbGa amiBaaWcbeaaaaa@427E@ , from;

τ actual = tan 1 ( δx δy ) MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibiabes 8a0LqbaoaaBaaabaqcLbmacaWGHbGaam4yaiaadshacaWG1bGaamyy aiaadYgaaKqbagqaaKqzGeGaeyypa0JaciiDaiaacggacaGGUbqcfa 4aaWbaaeqabaqcLbmacqGHsislcaaIXaaaaKqbaoaabmaabaWaaSaa aeaajugibiabes7aKjaadIhaaKqbagaajugibiabes7aKjaadMhaaa aajuaGcaGLOaGaayzkaaaaaa@5516@    (25)

Results

For all tested cases, the end-effector could arrive near the required position with the following error percentages;

– In the X-direction, the percentages of errors ranged from 2% to 7% of the total required X-distance.

– In the Y-direction the percentages of errors ranged from 2.5% to 8% of the total required Y-distance.

– In the Z-direction the percentages of errors ranged from 1.4% to 5% of the total required Z-distance.

– The end-effector orientations are accomplished with errors in angle (τ) of about 4.7%.

Conclusion

  1. a simple design and a mathematical model are suggested for a robot arm, whose workspace is a spherical region.
  2. The arm has nine links and eight joints.
  3. These suggested architecture and mathematical model helped to formulate the inverse kinematics of the positioning and orientation of the end-effector using four parameters that are functions of the coordinates (x, y, z) of the required destination of the tool end-tip
  4. The suggested design can deal with obstacles and singularity points.
  5. A simple model for the arm was built to check the reliability of the design. The arm could execute the instructions of end-effector movements and orientations
  6. The results showed that the accuracy of motion in the four DOF ranged from 92% to 98%,
  7. The inaccuracy in results may be because of the low resolutions of the used stepper motors.
  8. For future work, this arm will be redesigned considering the load distribution as well as the motion. Also, more advanced components should be used to improve motion accuracy.

Nomenclature

Alphabetic

a  vertex of the imaginary rectangle surrounding the arm

b  another vertex of the imaginary rectangle surrounding the arm

E the midpoint of the thickness of link L6 at joint ‘J6’, Figure 4.

J joint

L link

m  length of any one of links 2, 3, 4, and 5 Figure 2.

O the origin of frames 0 and 1, Figure 4.

Oa the projected length of links L2, L3, L4, L5 on plane X-Y Figure 2.

r  the radius of link 1, Figure 4.

t thickness of any one of the links (2-5), Figure 2.

w width of the four arm links together plus the base radius, (r), and half the width of link (L6), Figure 4.

XE, YE, ZE coordinates of point E, defined in frame 0.

X, Y, Z coordinates of the tool end-tip defined in frame 0.

Greek symbols

α angle between two adjacent arms.

β angle between the arm side and the Z-axis

ε inclination angle of the end-effector tool on X-Y plane

θ angle between the arm and the X-axis.

θnet the net angle rotated by the arm in the X-Y plane

θ MathType@MTEF@5@5@+= feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr 4rNCHbGeaGqiVu0Je9sqqrpepC0xbbL8F4rqqrFfpeea0xe9Lq=Jd9 qqaqpfpm0xbba9pwe9Q8fs0=yqaqpepie9Gq=f0=yqaqVeLsFr0=vr 0=vr0dd8meaabaqaciGacaGaaeqabaWaaeaaeaaakeaajugibabaaa aaaaaapeGaeqiUde3cdaWgaaqaaKqzadGaeSigI8galeqaaaaa@3E31@  the angle between the projections of the line (O a) and (OE) on plane X-Y.

Φ the angle between the position vector of (E) and the Z-axis

τ  the desired angle between the end-effector tool and the Y-Z plane

Subscripts

0, 8   indices of the joints and links

p   projected on the X-Y plane

Acknowledgments

None.

Conflicts of interest

The author declares that there is no conflict of interest.

Funding

None.

References

  1. Oliveira Glaufe, Oliveira Gladstone, Egoavil Ciro, et al. Development of robotic arm control system using computational vision. IEEE Latin America Transactions. 2019;17(8):1259–1267.
  2. Mohamed G Alkalla, Mohamed A Fanni. Integrated structure/control design of high-speed flexible robot arms using topology optimization. Mechanics Based Design of Structures and Machines. 2019;48(6):381–402.
  3. K Aishwarya, J Priyadharshini, G Rajeswari. Arduino controlled robotic arm. International Journal of Trend in Scientific Research and Development. 2018;2(3):1762–1766.
  4. B. Sundari, Sivaguru S. Design, and implementation of robotic arm using IOT. International Journal of Electronics and Communication Engineering (SSRG–IJECE). 2018;5(8):1–4
  5. B Alit Swamardika, IN Budiastra, IN Setiawan, et al. Design of mobile robot with robotic arm utilizing microcontroller and wireless communication. International Journal of Engineering and Technology (IJET). 2017;9(2):838–846.
  6. Rajashekar K, Hanumantha Reddy, Ruksar Begum T, et al. Robotic arm control using arduino. Journal of Emerging Technologies and Innovative Research. 2020;7(6):453–455
  7. Anisur Rahman, Alimul Haque Khan, Tofayel, Ahmed, et al. Design, analysis and implementation of a robotic arm. American Journal of Engineering Research. 2013;2(10):298–307.
  8. Mohammed Ali, Mohit Kumar. Jamming concept, in robotic ARM as EOAT. International Journal of Engineering Research & Technology. 2016;4(3):1–3.
  9. Yagna Jadeja, Bhavesh Pandya. Design and development Of 5-DOF robotic arm manipulators. International Journal of Scientific & Technology Research. 2019;8(11):2158–2167.
  10. Dishant Khosla, Manvinder Sharma, Sachin Krishan Khanna, et al. Smart robotic arm. Journal of Artificial, Intelligence Research & Advances. 2019;6(2):58–62.
  11. Rishabh Jain, Mohd Nayab Zafar, JC Mohanta, et al. Modeling and analysis of articulated robotic arm for material handling applications. IOP Conf. Series: Materials Science and Engineering. 2019; 012010.
  12. Ashraf Elfasakhany, Eduardo Yanez, Karen Baylon, et al. Design and development of a competitive low-cost robot arm with four degrees of freedom. Modern Mechanical Engineering. 2011;1:47–55
  13. Mustafa Bugday and Mehmet Karali. Design, optimization of the industrial robot arm to minimize redundant weight. Engineering Science and Technology, an International Journal. 2019;22(1):346–352
  14. Kurt E. Clothier and Ying Shang, A Geometric, approach for robotic arm kinematics with hardware design, electrical design, and implementation. Journal of Robotics. 2010:1–10,
  15. AO Oluwajobi, AA Oridate. Design and development of an educational 5-DoF robotic arm. International Journal of Robotics and Automation Technology. 2019;6:55–65.
  16. Meng Bi. Control of robot arm motion using, trapezoid fuzzy two-degree-of-freedom PID algorithm. Symmetry. 2020;12(4):665.
Creative Commons Attribution License

©2021 Pasha. This is an open access article distributed under the terms of the, which permits unrestricted use, distribution, and build upon your work non-commercially.