Professional Documents
Culture Documents
A Robotic Pepper Transplanter: Grad. Student Assoc. Member Asae Asae
A Robotic Pepper Transplanter: Grad. Student Assoc. Member Asae Asae
2 © 1986 American Society of Agricultural Engineers 0883-8542/86/0201 -0002$02.00 APPLIED ENGINEERING in AGRICULTURE
of the transplanter. The plants are picked from the plant
box and placed into the carousel. A mechanical plant
spacing mechanism consisting of the cam, gears, chains,
and a spacing sprocket powered by the press wheels
synchronizes the opening and closing of the carousel
cups with the kicker operation. The plant drops through
the guide hole into the opener shoe. It is pushed out of
the shoe by the floating kicker. After the plant leaves the
opener shoe, the press wheels cover the plant's roots with
soil while the kicker holds the plant upright.
An Apple He microcomputer was used for
programming and communicating with a Mark II
controller containing its own Intel 8748 microprocessor.
The Apple lie and the Mark II controller communicate
through an RS-232C interface. The Mark II can control
up to eight motors and monitor six interrupts. Micro-
switches connected to the interrupts can be attached to a Fig. 3—Modified transplanter with horizontal trays and manipulator.
maximum of six joints to serve as reset and/or limit
position detectors. The motors and drive systems are all
contained within the body of the manipulator. Each platform was mounted in its place to support the
articulation, except the wrist joint, is activated by a joint computer and the manipulator's controller. The four-
motor connected through a gear reducer to a sprocket cup carousel and the mechanical plant spacing
and chain drive. The specified lifting capacity with the mechanism were also removed. The manipulator was set
arm fully extended is 22.25 N and the gripping force is in place of the carousel. It dropped the plants directly
4.45 N. into the kicker shoe. The vertical tray holder was
The Rhino SX Series Mark II robot is a computer- replaced by a flat platform to hold the trays in order to
controlled mechanical arm having five degrees of better utilize the working space of the manipulator (Fig.
freedom and a gripper (Fig. 2). Each manipulator joint 3). Transplanter movement through the field was
uses a "bang-bang" control system and is moved by a 12 simulated by a rotating wooden disk mounted on a
VDC servo motor with two-phase, incremental optical variable speed electric motor. A series of small magnets
encoders for position feedback. As each motor shaft were mounted on the outer edge of the disk. A magnetic
rotates, the microprocessor in the controller monitors the proximity detector sent an electrical pulse to a counting
changes in the status of the two photo transistors on the circuit every time a magnet passed in front of it. The
encoder and counts the number of holes and the plant spacing could be determined by presetting a
direction of rotation to determine the joint position. Four reference count in the pulse counting circuit. The
of the joint motor encoders have six pairs of slots on each counting circuit was used to activate the manipulator
encoder disk for a joint position resolution of 0.14 deg for releasing the plant, and to turn on a dc motor driving the
the base, and 0.11 deg for the other joints. The gripper kicker arm and plate in the base of the furrow opener
motor and wrist rotate motor encoders have two pairs of shoe. When the proper plant spacing was reached, the
slots each to give a position resolution of 0.24 deg. manipulator dropped the plant through the guide hole
into the opener shoe. The kicker plate pushed the plant
PROCEDURE out of the opener shoe while keeping the plant stem
vertical. If the transplanter was travelling too fast for the
The seat was removed from the transplanter. A small manipulator to react, a signal was sent to the operator to
slow down. He was also notified if the travel speed could
be increased.
The workspace may be defined as the volume which
the gripper can reach with a particular orientation. For
the SR Mark II manipulator, all of the joints except the
gripper rotary joints have constraints on their movements
because of the manipulator's structure and the length of
the control wires connected to the joint motors. These
constraints become more complex when the intermediate
and final states of the link structure are considered. The
size and position of the trays were determined from the
desired grasp and drop configurations of the
manipulator for the efficient use of the workspace and
the overall travel amount of each joint. Two tray
positions were considered: inclined and horizontal. Due
to the structure of the linkages, the actuating sequence of
the motors, and the amount of motor travel between the
path nodes, the horizontal setting was more efficient for
this manipulator.
Optimization of the path of a manipulator may be
performed by minimizing the move of each joint motor or
Fig. 2—Robotic manipulator. the travel distance between the initial and final states of
the gripper end. The travel amount of each joint motor PROGRAMMING THE MANIPULATOR
can be varied depending on whether or not each joint is Since the XR Series Mark II manipulator does not
coupled. The trajectory of the manipulator end can be have any feedback from its environment, all of its moves
affected by this joint coupling property, the ways of data had to be stored in the computer's memory. All of the
transfer, and the control methods for the joint move. The data for all of the joint moves were computed before the
XR Series Mark II manipulator has coupled joints, actual transplanting tests. The data was stored in a disk
requires serial data transfer, and uses the "bang-bang" file. When a test was ready to be conducted, the data was
control method. The order of actuating the joint motors read into the computer's memory. This way, the
and the amount each joint moves at one time affects the computer was not required to perform any joint move
gripper trajectory. If the joint motors have large calculations during the actual transplanting. It had only
differences in speeds, the travel of each joint will be the to monitor the plant spacing and transfer the joint data
more important factor. The path of the manipulator had to the manipulator controller.
to be planned such that the manipulator did not collide The data for the joint moves can be obtained from an
with itself or with other parts of the transplanter. To inverse kinematic solution technique (Paul et al., 1981
minimize the path of the gripper, the manipulator and Denavit et al., 1955) or a differential transformation
needed to follow a straight line trajectory. This would technique (Paul et al., 1981 and Pieper, 1968) with an
require several intermediate node points in the path or extended Jacobian using a modified general Gauss-
velocity control for each joint. A node point is an elimination or a geometric analysis. For an inverse
intermediate point through which the gripper end must kinematic solution technique, the proper choice of the
pass between its beginning and ending points. A nearly joint position variable is necessary because the geometric
straight line trajectory and efficient use of the workspace property of the intermediate links gives two possible
could be achieved by introducing node points. However, solutions for the humanoid type structure. The
node points were not used because they slowed the speed characteristics of the trigonometric function should be
of the arm movement and reduced the overall considered to void degeneracy (Paul, 1982). A
transplanting rate. differential transformation technique with an extended
The manipulator must pick a plant from a tray Jacobian can also be used for the velocity control of each
containing a series of cells with a plant in each cell and joint and to follow a straight line trajectory. A geometric
transfer it to the drop position without damaging the analysis is relatively simple and requires less computing
plant (Fig. 4). For the pepper transplanter the tasks may time compared to the other techniques.
be defined as: approach plant, pick plant, lift plant,
approach drop position, release plant, and push kicker The Inverse Kinematic Solution Technique
arm. The independent coordinates are set up at each joint
For the horizontal setting, the adjustment of the pick, axis of the manipulator. Each coordinate has one
lift, and drop positions and the gripper approach angle prismatic or rotary joint variable. A coordinate
based on the geometric configuration of the linkage and transformation is used to transform unit vectors of one
the trajectory of the end are used to avoid collisions coordinate frame to those of the other. Each coordinate
without using node points. At the "lift" and "drop" system may be chosen arbitrarily to perform the
positions, the gripper angle was decreased to avoid a transformation most easily.
collision between the gripper and the tray and to increase Given a target position and orientation of the gripper
the tray areas by reducing the required drop area. The end in the ground coordinate system, n transformation
following states of the gripper were selected to perform equations can be obtained from an n deg-of-freedom
the transplanting task. manipulator. The solution is obtained sequentially by
Pick: 65 mm above the top of the cell at a 45 deg angle isolating each variable and multiplying by the inverse of
downward approach. the preceding joint transformations. The corresponding
Lift: 25 mm towards the base motor origin from the elements of each transformation equation yield 12 non-
pick position at a 225 mm lift height and 60 deg trivial equations. The proper equations are selected to
downward approach. obtain the solution. To obtain a unique solution without