1. Introduction
A mechanism is statically balanced when its total potential energy is kept constant in any configuration of the mechanism. For a mechanism in static equilibrium, the actuators do not work to sustain any conservative force acting on its moving members [Reference Martini, Troncossi, Carricato and Rivola1].
In most applications, assuming perfect rigidity of the mechanical members, the change in the potential energy of a mechanism is due to gravitational effects, and in this case, static balancing corresponds to gravity balancing or gravity compensation. There are several ways to obtain gravity balancing for parallel manipulators. If the overall center of mass (CoM) of the mechanism could be kept at the same level of height for any given configuration, the static balance is obtained. This is important because the unbalanced forces could cause adverse effects in the operation of the mechanism such as vibrations and joint wear [Reference Jean and Gosselin2]. Another way to obtain a statically balanced mechanism is to keep its total energy constant so it could be statically balanced in the direction of the gravity vector [Reference Russo, Sinatra and Xi3].
A statically balanced system has many advantages over an unbalanced system. Statically balanced systems have a very good energy exchange between the energy storage elements and the system; therefore, the mechanism needs minimal external energy input for operation. The decrement in the operating effort of the actuators gives opportunity for usage of smaller actuators since the actuators no longer work for compensating the gravitational effects. For a statically balanced system, the external energy input would be needed to cover the energy losses due to friction and to accelerate the mechanism [Reference Herder4].
The types of static balancers that are issued in this work are the counter-masses and springs. The main idea of using counter-mass is to exchange the gravity potential between the counter-mass and the balanced mass. One of the disadvantages of this balancing method is that it increases the inertia of the system, and the added masses could collide with the links within the workspace. In spring balancers, the change in gravitational potential energy in the system is compensated with springs. It is relatively easy to balance a mass which rotates about a fixed axis, but usually additional links are required for balancing floating links. This study makes use of both counter-masses and springs for gravity compensation.
Many researchers have worked on static balancing of parallel and serial manipulators for planar and spatial motion. For example, [Reference Martini, Troncossi and Rivola5] worked on an algorithm for balancing serial and parallel mechanisms where counter-masses, springs, and combination of counter-masses and springs are used together. Wang and Kong [Reference Wang and Kong6] developed a geometric method for static balancing of spherical mechanisms. Van Dorsser et al. [Reference Van Dorsser, Barents, Wisse, Schenk and Herder7] developed a system to adjust a spring and a linkage-based balancer by changing the active coils of the spring which effects its spring stiffness and allows the system to stay in balance when the payload changes in an energy-conserving way. Yaşir et al. [Reference Yaşir, Kiper, Dede, Van der Wijk and Uhl8] and Maaroof et al. [Reference Maaroof, Saeed and Dede9] have introduced two different partial gravity compensation solutions with springs for a 2URRR-URR parallel manipulator. Maaroof et al. [Reference Maaroof, Saeed and Dede9] achieved partial gravity compensation by using torsional springs on actuator shafts.
The 2URRR-URR parallel manipulator is designed as an endoscope holder for minimally invasive transnasal pituitary gland surgery application by ref. [Reference Yaşir, Kiper and Dede10]. In this work, the balancing solution of ref. [Reference Yaşir, Kiper, Dede, Van der Wijk and Uhl8] is slightly modified and formulated in detail. The balancing solution is implemented in parallel with the constructional design of the balancing components. The solution is verified via simulations and tested on the manipulator’s prototype. The presented methodology can be used for gravity balancing of parallel manipulators.
2. Description of the system and the need of static balancing
In the surgical system, called NeuRoboScope, the endoscope holder is a parallel manipulator assembled on a passive serial arm (Fig. 1(a)) which can be manually positioned by the surgeon during the surgery [Reference Dede, Kiper, Ayav, Özdemirel, Tatlicioğlu, Hanalioglu, Işikay and Berker11]. The end-effector of the parallel manipulator which holds the endoscope is placed through the nostril of the patient where there is a natural path to the pituitary gland. The surgeon uses additional surgical tools manually to remove the tumor. The endoscope is pivoted at the upper portion of a nostril, and it should be oriented (pitch and yaw motions) about and move along the pivot point (heave motion) (Fig. 1(b)). Without any static balancing, the torques generated by the motors during the operation are relatively high. Consequently, without the static balancing, the system is harder to control, it consumes more energy, and also in case of a malfunction, the manipulator is not able to keep the position of the endoscope and may cause serious damage to the patient.
The parallel manipulator has 3 degree-of-freedoms for the 2 R1T (2 rotations – 1 translation) motion required for orienting and the heave motion of the endoscope about the pivoting point, which is a remote center of motion (RCM) for the mechanism. The RCM mechanism has a 2URRR-URR kinematic structure, where U and R stand for universal and revolute joints, respectively (Fig. 2). The moving platform is connected to the base of the manipulator with three legs. Each leg comprises a proximal link which is connected to the base with a U joint, a middle link which is connected to the proximal link with an R joint, and a distal link which is connected to the middle link with an R joint. The moving platform is rigidly attached to the distal link of the middle leg, whereas the distal links of the two side legs can rotate with respect to the moving platform about the endoscope axis via circular sliders. Therefore, the side legs have a URRR structure, whereas the middle leg has a URR structure.
The legs define 3 planes intersecting along the endoscope axis. The 3 leg planes can rotate about 3 fixed axes on the base, which intersect at the RCM. The rotary actuators on the side legs have fixed axes on the base and actuate the first R axes of the U joints. The side leg actuators change the angle of the side leg planes with respect to the base plane, hence changing the intersection line of the plane. So side leg actuators are responsible for the orientation of the endoscope. The actuator on the middle leg actuates the second axis of the U joint, which is an axis perpendicular to the middle leg plane and can rotate about the first axis of the U joint. The middle leg actuator moves the endoscope like the slider of a slider-crank linkage on the middle leg plane; hence, it is responsible for the heave motion of the endoscope. The kinematic model and design of the mechanism are presented by ref. [Reference Yaşir, Kiper and Dede10].
A prototype of the NeuRoboScope system is built and presented by ref. [Reference Dede, Kiper, Ayav, Özdemirel, Tatlicioğlu, Hanalioglu, Işikay and Berker11]. The requirements of the balancing system to be implemented for this surgical system are as follows: (1) the passive robotic arm end-effector has 13 kg load limit, so the balanced system should have less than 13 kg mass and it is safer to have limited increase in the total inertia of the system, and (2) the additional parts for static balancing should not cause any link collisions. In order to avoid link collisions, the middle leg is not used for static balancing and the payload mass is distributed to two of the legs on the sides.
According to the abovementioned requirements, using counter-masses, CoM of each leg on the sides is lumped to the proximal link attached to the base platform. Hence, the balancing problem is simplified to a basic gravity equilibrator [Reference Herder4], that is, a spring-balancer for an inverted pendulum.
3. Implementation of the static balancing methods on the surgical robot
The counter-mass and spring balancing solution proposed by ref. [Reference Yaşir, Kiper, Dede, Van der Wijk and Uhl8] for a leg is depicted in Fig. 3. The mass of the moving platform including the endoscope is equally distributed to the side legs, and this half mass is denoted by m p. The mass of the distal link is m c with CoM at G c, mass of middle link is m b with CoM at G b, and mass of proximal link is m a with CoM at G a. The counter-mass M c at B c is used to balance m p and m c, to relocate the total CoM of the distal link to joint C. The counter-mass M b at B b is used to balance the total masses of the distal and middle links, to relocate the total CoM of the two links to joint A. Together with the mass m a of the proximal link with CoM at G a, the total CoM of the whole leg is at B a with mass M a.
Following similar steps, an equivalent inverted pendulum can be obtained for any articulated kinematic chain with revolute, universal, or spherical joints. For the inverted pendulum with rotation center A 0, the rotational degree of freedom of the joint at A 0 may be 1, 2, or 3, and the pendulum can be balanced with a spring [Reference Herder4].
The link lengths and the mass locations are represented as r c = |CG p|, r b = |AC|, r a = |AA 0|, b c = |CB c|, b b = |AB b|, g c = |CG c|, g b = |AG b|, g a = |A 0 G a| and g a,t = |A 0 B a|. The payload location is assumed to be at g pay = |CG p| = r c. The gravity acts along –y direction in Fig. 3, and η is the angle between the proximal link and the x-axis. According to the design by ref. [Reference Yaşir, Kiper and Dede10], η max = 89.63º and η min = –64.11º. The base plane of the manipulator makes an approximate angle $\delta$ = 28.5° with the horizontal. This is an average value for the manipulator orientation, and the balancing is partial when ${\unicode[Times]{x03B4}}$ takes some other value when locating the manipulator using the passive arm.
Using a basic gravity equilibrator, one end of the balancing spring is fixed at an arbitrary point on the base (point E 0 in Fig. 3), whereas a thin wire is attached to the other end. The thin wire passes through point D 0, which should be located on a vertical line passing through A 0, the center of the universal joint. The other end of the wire is connected to the proximal link. The length of the wire is adjusted so that the spring is unloaded when the proximal link is at an upright position, that is, along A 0 D 0. By this way, a system which behaves as a zero-length spring is obtained [Reference Herder4].
The workspace of the manipulator was defined by ref. [Reference Dede, Kiper, Ayav, Ateş, Tatlicioğlu, Özdemirel, Maaroof, Berker, Işikay and Hanalioğlu12] from the data of a computed tomography scan. With the results modified after considering the safety conditions and the results changing from patient to patient, the workspace of the manipulator is selected as $\varDelta\psi$ = 40° for the yaw motion, $\varDelta\phi$ = 30° for the pitch motion, and $\varDelta$ d = 100 mm for the heave motion of the endoscope. According to the selected workspace, link lengths of each leg are r c = |CG p| = 200 mm, r b = |AC| = 195 mm and r a = |AA 0| = 135 mm [Reference Yaşir, Kiper and Dede10].
The formulations for the counter mass values and locations and spring design are described below. First, the equivalent payload mass is calculated. In Fig. 4, 2m p is the equivalent payload mass, M 1 is the endoscope group mass, and m 1 is the middle leg distal link mass which includes the moving platform that carries the endoscope.
The payload mass 2m p is to be located at a distance r c = |CG p| = 200 mm from the axis of the R joint between the distal link and the proximal link. So,
For selected locations of the counter-masses, the counter-mass values can be computed from (see Fig. 3):
The total leg mass, M a, and the location of the CoM of the whole leg, g a,t:
When all masses are lumped to point B a, the problem of balancing has been reduced to a basic gravity equilibrator problem [Reference Herder4] as shown in Fig. 5.
Let e = |A 0 C a|, f = |A 0 D 0| and s = |D 0 C a|. The spring force F s is proportional to length |D 0 C a|:
where k is the spring constant. By using sine theorem in triangle A 0 C a D 0
Then by using Eqs. (6) and (7) and moment equilibrium for M a about A 0, spring coefficient is determined as:
where g is the gravitational acceleration.
The mass values M 1, m 1, m c, m b, and m a are measured from the parts of the available prototype. The CoM locations (g c, g b, g a) are determined using CAD models. Following Eqs. (1)–(8), the parameters to be selected are b c and b b for the counter-mass locations and e and f for the spring constant and wire connection locations. The constructional design details also should be taken into account when determining b c and b b. Each counter-mass is designed to have two main parts. One of the parts is an adjustable mass, and the other is to connect this additional mass to the corresponding link (Fig. 6). The connection parts have a constant mass and CoM position with respect to their corresponding joint axes. Cylindrical blocks are selected as the adjustable masses because of the ease of changing their dimensions.
The distal link counter-mass consists of four parts named D_CM_P1, D_CM_P2, D_CM_P3, and D_CM_P4. The parts D_CM_P1 and D_CM_P2 are parts of the connection elements and D_CM_P3 and D_CM_P4 are the cylindrical blocks. The unknowns to be determined are the height and radius of the cylindrical blocks.
In Fig. 7, the total mass of the connection parts is denoted with m 1 positioned at distance a with respect to the joint axis, and the total mass of the cylindrical blocks is denoted with m 2 positioned at distance c with respect to the joint axis. The radius and height for D_CM_P3 (thin and long cylinder) are r d and h 1, respectively, and the radius and height for D_CM_P4 are r e and h 2, respectively. Due to the constructional design considerations, D_CM_P3 is placed through the connection element D_CM_P2, and therefore, r d dimension is set. When D_CM_P3 is mounted on D_CM_P2, the base of the cylinder D_CM_P3 has a fixed distance of 38 mm with respect to the joint axis as shown in Fig. 8. To calculate the remaining unknowns, moment equilibrium equations are written with respect to the joint axis. The density for parts D_CM_P3 and D_CM_P4 are denoted with d 1 and d 2, respectively.
h 2 can be determined in terms of h 1 as follows:
where $A = \dfrac{{{m_c}{g_c} + {m_p}{r_c}}}{{{b_c}}} - {m_1},\,B = {d_1}\pi r_d^2\;\textrm{and}\;EC = {d_2}\pi \left( {r_e^2 - r_d^2} \right)$ .
To find h 1, a moment equilibrium for the masses located on the distal link is written with respect to the joint axis:
Substituting Eq. (9) in Eq. (10), a second-order polynomial in terms of h 1 is found and solved as:
where $M = \dfrac{{{B^2}}}{E} + \dfrac{B}{2},\,N = \, - \dfrac{{AB}}{E} - A\;\textrm{and}\;Q = \dfrac{{{A^2}}}{{2E}} - 38A + {m_c}{g_c} + {m_p}{r_c} - {m_1}a$ . To compute h 1 and h 2, r e should be specified. Once h 1 is found, h 2 can be calculated from Eq. (9).
The counter-mass for the middle link consists of five parts for the connection and adjustable counter-mass. Same as the distal link’s counter-mass, the adjustable masses are cylindrical blocks. The cylindrical blocks are named as CM_P3 and CM_P4. Height and radius of CM_P3 are denoted with h 3 and r f and for CM_P4 h 4 and r g, respectively. The unknowns (h 4, h 3, and r g) are calculated with the same method used in distal link counter-mass calculations.
There are several design considerations to determine the counter-mass distances b b and b c. They cannot be set unlimited, because after some point they may collide with the surroundings and block the sight of the surgeon since the manipulator is positioned in between the surgeon and the monitor of the endoscope. On the other hand, it is better to have them as long as possible to decrease total mass of the system. Also, although the balancing eliminates the gravitational effects, the inertia is increased and the motor has to compensate for the inertial force and moments due to the additional masses. In order to see the effect of b b and b c, a dynamical model of the system is constructed using MATLAB Simulink. The model of the robot is directly transferred from the CAD model to MATLAB via Multibody blocks. The trajectory of the end-effector used in simulations was obtained from workspace studies conducted by ref. [Reference Maaroof13], and the trajectory was measured by asking a surgeon to move the endoscope around the nostril of a cadaver. The trajectories for pitch ( $\phi$ ) and yaw ( $\psi$ ) angles are shown in Fig. 9 where the frequency of motion is approximately calculated as 0.1 Hz. By using this information and workspace studies, the trajectory for translation motion is designed where d i refers to initial of position d and d i is chosen at 155, 200, and 245 mm in simulations.
The simulation is run for 50 mm ≤ b b ≤ 300 and 100 mm ≤ b c ≤ 300 mm for 5 mm increments of b b and b c. The following set of conditions are set for r e, h 1 and h 2: (1) height of D_CM_P2 + h 2 < h 1 ≤270 mm and (2) r e/2 < h 2 ≤ 80 mm for both middle and distal links.
To compare the torque values for each combination of b b and b c, the average of the calculated root-mean-square (RMS) torque values is calculated by Eq. (12):
where RMS_1, RMS_2, and RMS_3 are the RMS torque values for the left, right, and middle leg actuators, respectively. By changing r g and r e values, the most compact design with the smallest total mass value is calculated using MATLAB. The resulting parameters are tabulated in Table I.
It is seen from the simulation results that without balancing components on the manipulator, G RMS = 3.06 N·m for the static analysis (no inertial effects) and G RMS = 3.08 N·m for the dynamic analysis. It is seen that gravitational effects outweigh dynamic effects. When the balancing components are included according to the dimensions given in Table I, the G RMS value in the dynamic analysis has decreased to 0.2 N·m which is a 93.5% decrease. The minimum torque values are obtained where d is at its maximum value of 250 mm which is the position where the tip of the endoscope is positioned at the entry of the nostril. The torque values start to slightly increase when the tip of the endoscope reaches the surgery area where d = 150 mm.
e = |A 0 C a| and f = |A 0 D 0| values (see Fig. 5) are determined according the constructional design. After the springs are manufactured and the spring coefficients are modified accordingly, e and f values are recalculated as seen in Table I.
4. Evaluation of the implemented static balancing methodology
After the calculations, the counter-mass components, the springs, and necessary connection components are manufactured. The manufactured spring coefficients are not exactly equal to the desired values. Simple tests with calibrated masses are performed to determine the spring coefficients of the manufactured springs. The coefficients are determined as k L = 1.804 N/mm and k R = 1.592 N/mm for the left and right leg balancing springs, respectively.
All manufactured balancing components are assembled on the prototype (Fig. 10). The two balancing springs are located on a plate fixed to the base platform of the manipulator. The wires are guided via an extra pin and spherical ball bearings between the spring and the proximal link. A tension adjustment component is manufactured to change the wire length for calibrating the springs.
The wires are connected to the links via two degree-of-freedom connection rings (Fig. 11). The inner ring is rigidly attached to the link, whereas the outer ring can rotate with respect to the inner ring and the wire within the grooves of the outer ring can rotate about the axis of the outer ring. It is observed that the endoscope can be manually repositioned quite easily.
Next, individual link balancing tests are performed by hanging the links with the counter-masses at their joint axes. Balancing condition is observed using water gauges and the locations of the cylinder blocks are slightly modified whenever necessary to achieve balanced links.
First, balancing tests for the manipulator are performed when the actuators are disabled in order to calibrate the springs (wire length and connection locations). It is observed that the endoscope can be manually located to any position within its workspace and static balance is obtained. These tests are important not to cause injuries to the patient in case of a motor failure. At every position, the end-effector location is measured using Faro Prime Arm – a coordinate measurement device. The targeted positions and the actual positions are in Table A.1 in Appendix A. It can be observed that the balanced manipulator can move to its boundary regions in each axis.
Finally, tests with functional actuators are performed with and without balancing components to see the effect of balancing on the actuator torques. During the measurements, it has been observed that the manipulator has some joint clearances. To measure the torque data of the motors, motor current values are monitored and also encoder data are recorded.
The balanced manipulator has been driven to the targeted positions via the motors, and once the endoscope is in the desired position, torque data have been collected. At each position of the manipulator, the endoscope position is measured with Faro Prime Arm. The torque and position data for the balanced manipulator are shown in Table A.2 in Appendix A.
From Table A.2, it can be seen that the position data from the encoder and Faro Prime Arm are different due to joint clearances in the mechanism. The position data from Faro Prime Arm have been accepted as the true position of the endoscope. In Table A.2, to see the general torque requirement at each position, the RMS torque values are calculated and also to see the general behavior average RMS torque has been calculated and the highest torque values for each leg and RMS torque are colored. Next, the balancing components are dismantled and tests are repeated for the unbalanced case. The resulting position and torque data are shown in Table A.3 in Appendix A.
When the manipulator’s balancing components are removed, it is observed that the effect of joint clearances is increased which especially affected the heave motion. Again, at each position, RMS torque values are calculated, and also, the average RMS torque value is calculated and tabulated in Table A.3 with the maximum torque requirements colored in red. The RMS torque data for the balanced and unbalanced case are compared to see the effect of the balancing components (Table II). Lower torque values are recorded in most of the case for the balanced case. It should be pointed out that the end-effector could not be located at the same pose at all positions (please compare Tables A.2 and A.3). Nevertheless, the comparison concludes that the overall average torque requirement is about 37.8% less in the balanced case. This is of course much less than 93.5% decrease, which was the result of simulations. The main reasons for the difference are the friction (which is not modeled in the simulations) and the joint clearances which result in joint flexibility.
5. Conclusions
In this study, a 2URRR-URR parallel manipulator is statically balanced using a hybrid spring and counter-mass balancing solution. Theoretically, each of the three legs can be balanced, but to avoid collisions with the passive serial arm, the payload mass is distributed to the legs on the sides. By adding counter-masses, distributed payload mass, distal and middle link masses are relocated to the proximal link, and the static balancing problem is reduced to balancing an inverted pendulum, which is achieved via a balancing spring.
With the additional balancing parts, the system’s total mass is 10 kg which is within the allowable limits with respect to the design constraints. With balancing, the RMS torque of the motors is decreased from 3.08 N·m to 0.20 N·m which corresponds to a 93.5% decrease according to the simulation results.
Test results with the balanced manipulator without motors coupled to the mechanism indicate that the manipulator’s end-effector can be statically balanced within its task space.
To measure the torque effects on the motors in the desired positions, the endoscope is positioned at several poses via the motors. The pose of the endoscope is measured with Faro Prime Arm. The differences between the desired and actual position data are the results of the joint clearances in the mechanism. The balancing components are removed from the manipulator and position, and torque data are recorded for the same set of positions of the endoscope. Based on these measurements, it is calculated that the average torque requirement from the motors is reduced by about 37.8% with balancing.
At the tested positions of the end-effector, the maximum torque requirement for the unbalanced case is 5.6 N·m (Table A.3), whereas it is 3.5 N·m for the balanced case (Table A.2). This is a significant decrease in terms of torque requirement and enhances the resolution of the actuators via enabling the choice of smaller actuators with less torque capacity.
The hybrid balancing methodology described in this work can be used for gravity balancing of parallel manipulators with articulated legs. Using counter-masses and springs for balancing have their respective advantages and disadvantages. With the proposed hybrid balancing solution, additional links are not used for the distal links, and the amount of additional mass is considerably reduced with the use of the spring for the proximal links.
Conflicts of interest
None.
Financial support
This study is funded by The Scientific and Technological Research Council of Turkey (grant number 219M483).
Ethical considerations
None.
Authors’ contributions
GK and CD initiated the project. AA performed the formulation, prototype production, and tests under supervision of GK and CD, whereas OA helped AA with the tests. AA wrote the article, and GK and CD edited the article to bring it to its final form.
Appendix A