The present invention relates to an information processing method and an information processing apparatus that edit position data and orientation data that identify the positions or orientations of parts of a robot apparatus, and display the state of the robot identified by the position data and the orientation data.
In recent years, for example, automatic production systems have been developed that cause an industrial robot apparatus to perform assembly simulating a human motion. It is required to perform programming (teaching) so as to allow an operation weaving between obstructions placed in surroundings, as with a human motion. For programming (teaching) a robot apparatus, an apparatus is sometimes used that is called a teaching pendant and allows the robot to actually perform an operation in a placement environment while accumulating and recording position and orientation data for performing the operation.
An information processing apparatus that has a hardware configuration substantially equivalent to that of a personal computer (PC) is sometimes used for programming (teaching) the robot apparatus. Such an information processing apparatus for programming (teaching) a robot apparatus has hardware including a displaying apparatus, a computer, a keyboard, and a pointing device. Such type of apparatus is configured so as to have a capability of programming (teaching) the robot operation through a form of a programming language for robot controlling or a form of a numeric value of position and orientation data. The information processing apparatus for programming (teaching) the robot apparatus may be used in an offline environment without actual connection to the robot apparatus.
Unfortunately, to cause the robot apparatus to perform, for example, an assembly operation simulating a human motion in consideration of interference with the surroundings, the teaching operation becomes significantly complex. This complexity tends to increase the man-hour for teaching and cause many teaching errors. In particular, the teaching operation that is performed in an offline environment incapable of confirming the actual operation of the robot using the information processing apparatus for programming (teaching) the robot apparatus as described above is difficult, and tends to cause problems, such as the increase in man-hour and teaching errors.
Here, as an example of a complex robot operation, a palletizing operation is discussed. The palletizing obtains (or obtains and moves, to another place) one by one, works (parts) accommodated in respective spaces in a box separated by partitions. In actuality, such a palletizing operation requires total two teaching points for each one of the works accommodated in the different positions. The teaching points are an obtaining position, and a hovering position before obtainment. The teaching point is described in a format such as the format of the position and orientation data on a predetermined reference part at a distal end of a robot arm. For processing multiple works, at least the two teaching points are required to be taught for each of the works. In the case of teaching all the teaching points through manual teaching operations, the more the number of works increases, the more the man-hour for teaching increases. The increase significantly complicates the operations.
There is a scheme for simplifying the teaching. This scheme is a teaching method of obtaining the amount of relative movement from one reference teaching point to the next teaching point based on designed values, and setting the relative value as an offset. According to this method, in the case of the palletizing operation, a teaching point corresponding to a work can be taught only by teaching the reference teaching point corresponding to one work serving as a reference and subsequently setting offsets for other works.
The following Japanese Patent Application Laid-Open No. H8-328637 and Japanese Patent Application Laid-Open No. 2010-188485 disclose techniques that use a scheme of setting a relative value as the offset of the reference teaching point to thus set the relative value in the different coordinate system direction as the offset. Japanese Patent Application Laid-Open No. H8-328637 describes a method of setting an offset in a base coordinate system direction of a robot from a teaching point serving as a reference through use of an offset variable in an operation program, and performing trajectory calculation, thereby achieving movement to an offset position and orientation. The advantage of the offset is to easily achieve the movement of a robot in the horizontal, back-and-forth, and lateral directions. However, for an offset through much use of an oblique direction, translation, and rotation, matrix calculation according to the direction and angle is required. This calculation causes a problem of being susceptible to calculation and setting errors.
Meanwhile, Japanese Patent Application Laid-Open No. 2010-188485 discloses a method of setting an offset in a direction of a tool coordinate system defined at a distal end of a tool of a robot from a teaching point serving as a reference through use of an offset variable in an operation program, and performing trajectory calculation, thereby achieving movement to an offset position and orientation. The tool coordinate system is, for example, a coordinate system having an origin that is a tool center point (TCP) arbitrarily set by an operator. According to this method, for example, in the case of movement of a reference part in an oblique direction, the TCP is set so as to align the oblique direction with one direction of the tool coordinate system on the same straight line, and a relative value serving as the amount of movement in one direction is set. These settings allow movement in the desired oblique direction to be achieved.
As in Japanese Patent Application Laid-Open No. 2010-188485, it can be considered that a coordinate system, except a base coordinate system, allowing an operator to easily grasp the state, for example, the tool coordinate system, is used to facilitate an operation of setting a teaching point through, e.g., input of numeric values, and can reduce setting errors. For example, use of the tool coordinate system can input or edit the teaching point through relative value information in a coordinate system allowing the operator to easily imagine the state, such as an indicating direction with respect to the current orientation of the robot. Consequently, data operation, such as calculation of relative value information from a designed value is facilitated, thereby allowing the teaching man-hour and operational errors to be reduced. In the case of palletizing, teaching can be performed by setting one of work obtaining positions as a teaching point that is to be a reference, and setting the residual work obtaining positions and pre-obtaining positions, for example, as offsets in the base coordinate system relatively at regular intervals.
Here, both the case of performing teaching using a teaching pendant at an installation site while operating an actual robot and the case of performing teaching in an offline using the information processing apparatus as described above have advantages and disadvantages. For example, in the case of the palletizing, confirmation of the position and orientation having been offset according to the setting through use of an actual robot has a possibility that the robot interferes with a partition in the box during the confirmation. Meanwhile, a wide variety of schemes for inputting a teaching point using the offset can be prepared for the information processing apparatus for offline usage. Even without an operation of an actual robot, programming can replace such an operation. Consequently, the operation can advantageously be confirmed without causing interference with the placement environment.
Thus, in recent years, a configuration allowing the information processing apparatus for offline usage to perform offline teaching and confirmation of operation has been proposed. For example, instead of using a created teaching data to operate an actual apparatus, trajectory calculation based on a teaching data or three-dimensional model rendering is performed to cause a virtually displayed robot to operate in a display screen to confirm the operation. The following Japanese Patent Application Laid-Open No. 2014-117781 discloses a displaying apparatus and a teaching point formation method that form the teaching point in a virtual environment, create an operation program using the formed teaching point, and reproduce the operation trajectory of a robot in the virtual environment, thereby allowing confirmation of the state of interference with the operation of the robot.
It can be considered that if the operation trajectories created by Japanese Patent Application Laid-Open No. H8-328637 and Japanese Patent Application Laid-Open No. 2010-188485 are reproduced in the virtual environment according to Japanese Patent Application Laid-Open No. 2014-117781, the state of the complicated position and orientation can be confirmed without using an actual robot.
Unfortunately, the method of teaching (programming) the robot using such a virtual environment has some technical problems.
For example, the information processing using the offset calculation and a plurality of different robot coordinate systems obtains the position and orientation having been offset through trajectory calculation. In this case, if the position and orientation having been offset are within a movable range due to hardware limitation of the robot arm, actual movement of the robot causes no problem. However, the movable range of the robot is sometimes exceeded at the middle of the trajectory in case the operation program is erroneously created. In case a trajectory calculation error occurs, confirmation cannot be displayed any more without solving the occurring error. In the palletizing, correction of the teaching point serving as the reference changes the associated position and orientation having been offset. This change sometimes causes the position and orientation having been offset to be out of the movable range.
However, the conventional techniques have a problem in that error handling in the case where the position and orientation data is changed by an offset input or newly created cannot sufficiently be performed. For example, in information processing according to conventional robot control data (teaching data), for example, the position and orientation data is often stored, in a storing apparatus, as a simple flat data list containing items sequentially arranged along a time series where the reference part of the robot is moved. However, an actual robot control data (teaching data) sometimes has a relationship where change in the position and orientation data at a specific teaching point affects the position and orientation data at one or more other teaching points. For instance, the relationship between the reference teaching point of palletizing and another teaching point associated through an offset constitutes an example.
The conventional techniques often store position and orientation data as a simple flat data list. Accordingly, it is not easy to identify the range of the other position and orientation data affected by change in the position and orientation data at a specific teaching point. Consequently, in the information processing according to the conventional robot control data (teaching data), even if the position and orientation data at the specific teaching point is changed, it is not easy to identify the range subjected to a check process of whether the trajectory calculation or operation is within the movable range or not. Accordingly, even if the position and orientation data at the specific teaching point is input, edited or corrected, the display of the operation confirmation related to the change cannot immediately or sufficiently be performed in the conventional technique.
Also as to error checking on trajectory calculation, according to the storing format at the teaching point (position and orientation data) as described above, there is, for example, a possibility that the calculation cannot be performed without designation of the range of the stored teaching point to be subjected to trajectory calculation by a user. The conventional techniques can determine whether a trajectory calculation error (e.g., the position and orientation at the specific part is out of the movable range) occurs or not, only through trajectory calculation for the designated range. Consequently, even if a specific teaching point is input, edited or corrected, the trajectory calculation error cannot immediately be checked, and the user cannot confirm the trajectory calculation error at timings of the input, edit and correction.
In view of the above problems, when the position and orientation data of a robot apparatus is input, edited or corrected, the range of the affected position and orientation data should immediately be identified, and the error checking on trajectory calculation for the position and orientation data in the range should be allowed to be performed. In the process of inputting, editing or correcting the position and orientation data related to the teaching point, the progress of the input, edit or correction during execution should be allowed to be confirmed substantially in real time according to the operation through, for example, one of virtual display output and numeric value display. In input, edit or correction of the position and orientation data, the position and orientation data should be allowed to be designated through a relative value that is an offset, and a robot coordinate system that is easily grasped should arbitrarily be selected among multiple robot coordinate systems and used. Furthermore, the data structure for storing the position and orientation data of the robot apparatus should be improved.
According to an aspect of the present invention, provided are information processing method and apparatus using: a displaying apparatus that includes a virtual environment displaying unit of virtually displaying a state of a robot apparatus identified by a plurality of position data and orientation data identifying a position or an orientation of each part of the robot apparatus, and a parameter displaying unit of numerically displaying the position data and the orientation data; an operating input unit of editing content of the position data and the orientation data; and a controlling apparatus that performs information processing of controlling display on the displaying apparatus according to an operation and input through the operating input unit, and performed therein are: first calculating, when an operation and input of changing a part of the position data and the orientation data are performed through the operating input unit, causing the controlling apparatus to change the part of the position data and the orientation data according to content of the operation and input; second calculating that causes the controlling apparatus to perform position and orientation calculation that identifies the position or orientation of each part of the robot apparatus, based on the part of the position data and the orientation data changed in the first calculating, and calculate new position data and new orientation data based on a result of the position and orientation calculation; and display updating that causes the controlling apparatus to update content of virtual display on the virtual environment displaying unit or numeric value display on the parameter displaying unit of the displaying apparatus, based on the part of position data and orientation data changed in the first calculating, and the new position data and the new orientation data calculated in the second calculating.
In the case where different parts of the robot apparatus have a specific dependent relationship that can be identified based on the structure of the robot apparatus, the data structure allowing a storage unit to store the position and orientation data may has a configuration that stores the multiple position data and orientation data corresponding to the respective different parts as hierarchic structure data.
According to the configuration, when the position and orientation data of a robot apparatus is input, edited or corrected, the range of the affected position and orientation data can immediately be identified, and the error checking on trajectory calculation for the position and orientation data in the range can be allowed to be performed. In the process of inputting, editing or correcting the position and orientation data related to the teaching point, the progress of the input, edit or correction during execution can be confirmed substantially in real time according to the operation through one of virtual display output and numeric value display. Consequently, the operation man-hour can be reduced. The multiple position data and orientation data of the robot apparatus are thus stored as the hierarchic structure data, which allows associated position data and orientation data to be automatically edited in an appropriate manner according to input, edit and correction operations, and allows the result to be appropriately reflected in the virtual display output or the numeric value display.
Further features of the present invention will become apparent from the following description of exemplary embodiments with reference to the attached drawings.
Preferred embodiments of the present invention will now be described in detail in accordance with the accompanying drawings.
Hereinafter, referring to embodiments illustrated in the accompanying diagrams, modes for implementing the present invention are described. The following embodiments are only exemplary ones. For example, the detailed configuration can appropriately be changed by those skilled in the art in a range without departing the gist of the present invention. Numeric values described in the embodiments are for reference purposes, and do not limit the present invention.
Hereinafter, referring to
The displaying apparatus C may be a displaying apparatus, such as an LCD (or a displaying apparatus with another display scheme). The displaying apparatus C may be configured by stacking what is called a touch panel on the display screen of the apparatus. In such a case, an input operation equivalent to an operation for an operation device, such as a pointing device or a keyboard of the operating input unit D, may be achieved through the touch panel. In some cases, a configuration without the operating input unit D may be adopted.
The information processing apparatus A of this embodiment is configured so that the apparatus can be used to input, edit and change the teaching data of the robot apparatus mainly in an offline environment rather than an online environment where the apparatus is actually connected to the robot apparatus and this apparatus is operated. The information processing apparatus A of this embodiment is configured so as to allow operations of inputting, editing and changing the teaching data for the robot apparatus to be performed through the operating input unit D, and can display, for example, a display screen E for the offline teaching system as illustrated in
The display screen E in
The virtual environment screen 10, the parameter setting screen 20, and the management screen 40 may be configured as graphical user interfaces (GUIs). In this case, display objects (such as a menu, input fields for numeric values and characters, and a virtual display of the robot arm) constituting the display screen E are configured so as to allow operations through the pointing device, such as a mouse, (or the touch panel) of the operating input unit D. Details of a method of implementing such a GUI environment are almost publicly known. Consequently, the detailed description of the method is herein omitted.
On the virtual environment screen 10 (virtual environment displaying unit), a virtual environment is displayed. In the virtual environment, a placement environment equivalent to that of the actual robot apparatus to be programmed (taught) by this apparatus is reproduced. For example, the virtual environment screen 10 virtually displays the state of the robot 101 apparatus identified by the position and orientation data in a three-dimensional model representation, such as of a three-dimensional CAD model. In this case, the display control function of a CPU (33), described later, for controlling the displaying apparatus C renders, for example, a three-dimensional image of the robot 101 at the position and orientation identified by the position and orientation data in a virtual space that simulates the operating environment of the robot 101, and achieves virtual display. Such (image) displaying control for virtually displaying the robot 101 through three-dimensional CAD model representation according to the position and orientation data is publicly known. Consequently, the detailed description of this control is herein omitted.
In the case of
Many robot apparatuses adopt coordinate data for representing the position and orientation data. Coordinate data items in some different coordinate systems are used to represent the coordinate data. For example, the robot 101 dealt with by this apparatus adopts a base coordinate system 104 (absolute coordinate system 100) and a tool coordinate system 105. In this embodiment, the base coordinate system 104 of the robot 101 is arranged at a position that coincides with the absolute coordinate system 100 of the virtual environment. At the distal end of the tool 102, there is the tool coordinate system 105. These coordinate systems are three-dimensional coordinate systems. On the virtual environment screen 10, the coordinate axes that are the three axes (X, Y, Z) can be displayed as illustrated in the diagram, as necessary.
On the virtual environment screen 10 exemplified in
In this case, a method of teaching an offset teaching point 107 set using a relative value that is an offset from the teaching point 106 serving as the reference, on an upper surface of the work 103 is used, for example. In this case, the relative value of the offset used for the teaching point 106 is represented by a numeric value, such as the amount of movement (distance) in the Z-axis direction, for example. On the virtual environment screen 10 in
Furthermore, the parameter setting screen 20 is displayed on the display screen E of the displaying apparatus C. In this embodiment, the parameter setting screen 20 has both a function as a parameter displaying unit that displays a numeric value of the position and orientation data, and a function of a parameter setting unit that sets the value through a GUI operation. On the parameter setting screen 20, parameters representing the current position and orientation of the robot 101 are represented in a form of numeric value representation at respective display positions. The display positions of the numeric values corresponding to the respective parameters on the parameter setting screen 20 are each configured as what is called an input box for numeric value (character) input. A configuration is adopted where the numeric values (or characters) in the input boxes for these parameters can newly be input and values having already been input can be changed by an operation through the operating input unit D. The details of hardware and software for implementing such a user interface through the input boxes are publicly known. Consequently, the detailed description is herein omitted.
The teaching data (the entities of the teaching point, the position and orientation and numeric value data) for controlling the robot apparatus (robot 101), and model information for modeling or rendering in three-dimensional model representation on the virtual environment screen 10 are stored and managed in a format of a hierarchic data.
A RAM 35b and an external storing apparatus 35c of the storing apparatus 35 are used as storage units for storing the multiple position data and orientation data. For example, in the case of presence of a specific dependent relationship according to which different parts of the robot 101 are identified by the structure of the robot apparatus, the multiple position data and orientation data corresponding to the respective different parts are stored as the hierarchic structure data in the storing apparatus 35.
The structure and details of the hierarchic structure data can be understood through, for example, illustration of the following management screen 40 (management displaying unit).
That is, in this embodiment, the management screen 40 (management displaying unit) for displaying the data structures of the teaching data (the teaching point and the position and orientation data) and the model information is displayed on the display screen E of the displaying apparatus C. On the management screen 40, the model information displayed on the virtual environment screen 10 and the teaching point information are comprehensively subjected to node management, and the state is displayed in a form of what is called a tree diagram.
The node management related to the teaching data and the model information in this embodiment adopts a data structure which defines the model information on the root at the top as the absolute coordinate system 100 (ROOT), and indicates the association between multiple model information items in branches and the hierarchic structure in the absolute coordinate system (100). In the data structure of the position and orientation data in this embodiment, a model close to the root is called a parent model, and a model close to a leaf is called a child model.
It is assumed that information managed as association holds the relationship between parent and child pieces of model information, and the relative value information representing the position and orientation of the model from the parent to the child. Note that information managed by node management related to the teaching data and the model information in this embodiment is not limited to the relative value information. For example, the absolute value information corresponding to the positions and orientations of the models from the root to the child may be stored.
The data storing format of the (hierarchic) node format for managing the teaching data and the model information in this embodiment may adopt a format that is, for example, a linked list that associates the data on each node through, e.g. an address pointer, and stores the data on a memory. Alternatively, in the case of storing the teaching data and the model information in a file system in an external storing apparatus, such as an HDD or SSD, a data storing format in any of various types of relational database systems may be adopted.
Through the entire specification, the display of the management screen 40 is dealt with as visual representation of a hierarchic tree structure that includes the nodes of the teaching data (position and orientation data) stored in the storing apparatus 35. Meanwhile, the illustration of the management screen 40 can be considered as memory map representation of the teaching data (position and orientation data) on the tree structure stored in the storing apparatus 35.
According to the node management described above, when the relative value information serving as the position and orientation of the parent model is changed, traceability can be achieved according to the parent model because the child model holds the relative value information corresponding to the position and orientation of the model from the parent to the child.
According to the data structure displayed on the management screen 40 in
Next,
The CPU 33 performs a system control for the entire information processing apparatus A. The CPU 33 performs the control calculation for the calculating unit 34 based on an input performed by the operating input unit D and an edit operation. The control calculation of the calculating unit 34 generates display control information for updating the display on the displaying apparatus C, and updates the teaching data and the model information stored in the storing apparatus 35.
The storing apparatus 35 stores the three-dimensional CAD model information displayed on the virtual environment screen 10, placement environment information, and the teaching data. In particular, the teaching data and the model information are stored in the (hierarchic) node format. Various types of data stored in the storing apparatus 35 are output according to a request issued by the CPU 33, and updated according to a request issued by the CPU 33.
According to a request issued by an external apparatus or a specific operation through the operating input unit D, the CPU 33 can transmit the various types of data stored in the storing apparatus 35 in the format of the file F through the interface 36. Furthermore, the file F can be read from the outside via the interface 36, as necessary. For example, at activation of the information processing apparatus A or in a restoring process, the file F having previously been output can be read from the external apparatus (e.g., any of external storing apparatuses, such as external HDD, SDD and NAS), the storing apparatus 35 can be updated, and the previous storing state can be reproduced.
In this embodiment, the storing area in the storing apparatus 35 that stores the teaching data and the model information for the robot 101 may arbitrarily be defined. For example, a predetermined area on the RAM 35b and a storing area (e.g., corresponding to a predetermined file) of the external storing apparatus 35c may be used.
What has been described above is one example of the entire configuration of the information processing apparatus A. For example, the hardware configuration such as of the personal computer B has thus been exemplified as an example of a system suitable for offline teaching. However, the information processing apparatus A is not limited to the offline teaching system. Alternatively, this apparatus may have a hardware configuration, such as of a teaching pendant that is placed at a location with the robot apparatus. In this case, if a displaying apparatus of the teaching pendant has a configuration capable of displaying a virtual environment screen equivalent to what has been described above, a configuration equivalent to that of this embodiment can be implemented.
As an example of the formation and editing processes in this embodiment, processes of forming and editing the offset teaching point 107 in the configuration described above are described. The processes of forming and editing the offset teaching point 107 perform different processes and display according to an operation through the operating input unit D and the GUI on the displaying apparatus C.
For example, as to the offset teaching point 107 in
As to the processes of forming and editing the offset teaching point 107, the following four cases are hereinafter described. These processes are forming and editing processes in “the case of selecting the tool coordinate system 105”, “the case of selecting the base coordinate system 104”, “the case of switching the coordinate systems”, and “the case of editing the teaching point 106 serving as the reference”.
(Formation of Offset Teaching Point Using Tool Coordinate System)
The first case, that is, procedures and process for forming the offset teaching point 107 by selecting the tool coordinate system 105 are described with reference to
The ROM 35a corresponds to a recording medium that is for storing an information processing program, as described later, and is readable by the computer (CPU 33). The CPU 33 executes robot control including torque control, as described later, by executing the information processing program stored in, for example, the ROM 35a. A part of the ROM 35a may be made up of a rewritable nonvolatile region, such as E(E)PROM. In this case, the nonvolatile region may be made up of a computer-readable memory device (recording medium), such as a flash memory or an optical disk, not illustrated. For example, the memory device is replaced, which allows the information processing program to be installed or updated. The information processing program obtained via the network may newly be installed in the rewritable nonvolatile region. The information processing program stored in the rewritable nonvolatile region can be updated with data obtained from the computer-readable recording medium or via a network.
According to the processing procedures in
On the parameter setting screen 20 in
The absolute value setting unit 201 is used to input an absolute coordinate value in, for example, an absolute coordinate system (e.g., the base coordinate system 104). The relative value setting unit 202 is used to input a relative coordinate value in, for example, a relative coordinate system (e.g., the tool coordinate system 105). The coordinate system selecting unit 204 constitutes a coordinate system designating unit for designating one of different coordinate systems used in relation to the robot 101, as a coordinate system used to display a coordinate value corresponding to the position and orientation data on the parameter setting screen 20.
In newly forming the offset teaching point, the teaching point (106) serving as the reference is required to be set. In the case of setting the teaching point 106 serving as the reference (teaching point setting unit; step S1 in
For example, the user clicks the teaching point setting unit 203 in
After the selection of the teaching point 106 serving as the reference is thus completed, the CPU 33 reads the parameter of the selected teaching point “P001” recorded in the storing apparatus 35, and updates the display screen E of the displaying apparatus C based on the read parameter. More specifically, display “REFERENCE” in the teaching point list 206 is switched to display corresponding to the teaching point “P001” as in
At this time, the display of the virtual environment screen 10 of the displaying apparatus C can be updated to, for example, the display as in
In this embodiment, any coordinate system can arbitrarily be selected to input a new offset teaching point 107 (coordinate system selecting unit; step S2).
For example, the user clicks the coordinate system selecting unit 204 at the cursor 205 of the mouse as illustrated in
As illustrated in
In this stage, the user can set a relative value that is an offset of a new offset teaching point 107 (parameter setting unit; step S3).
A part above the absolute value setting unit 201 and the relative value setting unit 202 serves as a teaching point name setting unit 212 where a teaching point name to be created is input and displayed. Here, the user inputs a desired teaching point name (e.g., “P100” in the example in
In the input of the new offset teaching point 107, the initial state of every field in the relative value setting unit 202 is zero (
At this stage, as described above, as illustrated in
For example, the user selects the setting field 208 corresponding to the field for the Z-coordinate value in the relative value setting unit 202 using the mouse of the operating input unit D as illustrated in
In response to the numeric input into the relative value setting unit 202, the CPU 33 updates the content in a memory area corresponding to the relative value setting unit 202 arranged on, for example, the RAM of the storing apparatus 35. That is, when operation and input of changing a part of the position and orientation data through the operating input unit D are made, the part of the position and orientation data is changed according to the content of the operation and input (first calculating).
When the [Enter] key of the keyboard of the operating input unit D is pressed, position and orientation calculation in the calculating unit 34 made up of software for the CPU 33 is started (orientation calculation unit).
First, it is herein determined whether the coordinate system selected in relation to the offset teaching point 107 is the tool coordinate system 105 or not (step S4 in
Here, the articulation value is represented by the bending (rotation) angle of a certain articulation of the robot 101, and is an articulation data that identifies the position (or orientation) of the articulation. In this embodiment, such an articulation data is used to check a limitation error, described later, in the middle of the calculation. An example of directly inputting and editing the articulation data as a part of the position and orientation data in an explicit manner is described in Embodiment 5, described later.
Here, the calculation in the case of selecting the tool coordinate system 105 is performed according to the following equation (1) (coordinate transformation). Here, an orientation matrix T3 of relative values of the robot 101 from the base coordinate system 104 to the offset teaching point 107 is calculated as a product of an orientation matrix T1 of relative values of the teaching point 106 serving as the reference and an orientation matrix T2 of relative values serving as offsets.
T
3
=T
1
·T
2 (1)
Here, the orientation matrix T is a matrix with four rows and four columns as represented in the following equation (2). Parameters on the first row and the first column to the third row and the third column constitute a rotation matrix R. The parameters on the first to third rows and the fourth column constitute a position matrix P. The parameters on the fourth row and the first column to the fourth row and the third column constitute a 0 matrix. The parameter on the fourth row and the fourth column is one.
An inverse kinematic calculation is applied to the calculation result of the equation (1) to calculate the articulation value of each axis of the robot 101. That is, in step S5 (or S6, described later), the CPU 33 performs position and orientation calculation that identifies the position or orientation of each part of the robot apparatus, based on a part of the position and orientation data (on the offset teaching point 107) changed in the first calculating. Based on the result of this position and orientation calculation, new position and orientation data (e.g., articulation value) is obtained (second calculating).
Furthermore, the CPU 33 updates the display of the display screen E of the displaying apparatus C, based on the result of the inverse kinematic calculation (steps S7 to S9 in
In the updating of the display of the display screen E of the displaying apparatus C, for example, the content of the management screen 40 of the displaying apparatus C, the virtual display on the virtual environment screen 10, and the numeric value display on the parameter setting screen 20 is updated. Before the updating of the display screen E of the displaying apparatus C, error checking is performed on whether each articulation value corresponding to the position and orientation data calculated in the second calculating is within a limitation defined by the hardware specifications of the actual robot 101 or not (the following step S7).
In step S7, it is determined whether each articulation value on the offset teaching point 107 is within the limitation defined by the hardware specifications of the actual robot 101 (or further by operational regulations) or not (limitation determining process). For example, in the actual robot apparatus, the range of possible rotation angle of a certain articulation is sometimes limited within a specific range. It is determined whether each articulation value of the robot 101 is within such a range of limitation or not. Such conditions of limitation including the movable range of the robot 101 have preliminarily been stored in the ROM 35a, the RAM 35b, or the external storing apparatus 35c, in an appropriate storing format.
When the result of the determination in step S7 is within the limitation, the CPU 33 updates the display screen E of the displaying apparatus C (normality displaying process; S9). Here, the display of the robot 101 on the virtual environment screen 10, and the content of the parameter setting screen 20 are updated. Here, the base coordinate system 104 of the robot 101 coincides with the absolute coordinate system 100 as described above. Consequently, the update is performed by reflecting the relative value from the base coordinate system 104 to the offset teaching point 107 in the absolute value setting unit 201, and the result of calculation of the articulation value on each axis of the robot 101 by the inverse kinematic calculation on the virtual environment screen 10.
Furthermore, in the updating of the display screen E of the displaying apparatus C, all the GUIs (the virtual environment screen 10, parameter setting screen 20 and management screen 40) including the changed points and unchanged points are updated. Consequently, for example, the parameter setting screen 20 is updated as illustrated in
As described above, when an input is made into the relative value setting unit 202 through the operating input unit D, the display of the robot 101 on the virtual environment screen 10 and the display on the parameter setting screen 20 are immediately updated, thereby allowing the position and orientation and the parameters on the new offset teaching point 107 to be confirmed.
Consequently, even if the robot apparatus is actually not connected to the information processing apparatus A or if the actual robot apparatus is not operated, the user (operator) can confirm the validity of the input (edit) operation only by viewing the display screen E of the displaying apparatus C. Thus, the man-hour having conventionally been required to confirm the validity of the input (edit) operation can be reduced.
According to the result of the position and orientation calculation, for example, when any of the articulation values is determined to be out of the hardware limitation in step S7, the CPU 33 causes the displaying apparatus C to display an error indicating unavailable orientation (abnormality displaying process; S8). For example, in this case, an error screen 50 to be displayed may be a screen as in
In the case of displaying this screen, the CPU 33 clears the numeric value on the offset teaching point 107 on the parameter setting screen 20 and returns the state to the state before input of the relative value (e.g.,
That is, the CPU 33 determines whether the obtained position and orientation data is within the limitation of the mechanism of the robot 101 or not according to the result of the calculation in the second calculating. When the position and orientation data exceeds the limitation of the mechanism of the robot apparatus, error information notifying an editing error (e.g., the error screen 50) is generated.
Subsequently, the user viewing the display of the robot 101 on the virtual environment screen 10 and the display of the parameter setting screen 20 performs an operation of confirming whether the aimed orientation to be reached is achieved or not (step S10). In step S10, when the aimed orientation to be reached is achieved on the offset teaching point 107, a confirmation operation is performed that selects the determination button 209 using the cursor of the mouse and clicks the mouse. This confirmation operation finishes the forming of the offset teaching point 107. Thus, the CPU 33 stores the information on the confirmed offset teaching point 107 in the storing apparatus 35.
As described above, the forming of the new offset teaching point 107 is finished (recording unit; step S11 in
As to forming of the new offset teaching point 107, the display of the management screen 40 can also be updated under control of the CPU 33. Here,
After the new offset teaching point 107 is normally formed as described above, the node on the new offset teaching point 107 is newly formed at the descendant of the teaching point 106 serving as the reference on the management screen 40 for nodes. The node of the new offset teaching point 107 is thus displayed at the descendant of the teaching point 106 serving as the reference. Consequently, the user can significantly clearly recognize that the offset teaching point 107 is a (an offset) teaching point having a relationship where this point 107 belongs, as a child, to the node of the parent teaching point 106.
Each of the nodes on the management screen 40 in
The position and orientation data stored in the storing apparatus 35 can be output to an external apparatus (input and output unit) in units of the entire tree (e.g., the entire tree of each of
The file F having thus been output can be read via the interface 36 later. Consequently, if, for example, the entire tree (e.g., the entire tree of each of
The file F may be adjusted (converted) to have a format common to the controller of the actual robot apparatus, and output from the interface 36. Consequently, the teaching data created by the information processing apparatus A can directly be input into the actual robot apparatus.
Here, for example, the interface of the controller of the actual robot apparatus is made up of an operation program and an offset variable in some cases. In such cases, a mode can be considered where the CPU 33 outputs the information on the teaching point 106 serving as the reference, as the teaching point information, via the file F, while outputting the offset teaching point 107 as the offset edit information on the operation program.
Furthermore, a configuration can be considered where the interface of the teaching point information on the controller of the actual robot apparatus uses only the relative value information from the base coordinate system 104 of the robot. In such cases, the CPU 33 can calculate the product of the offset teaching point 107 and the teaching point 106 serving as the reference, convert the entire teaching point information into the relative value in the base coordinate system 104 of the robot, and output the value via the file F.
As described above, in the case of input and output of data via the interface 36 and the file F to and from an external apparatus, particularly an actual robot apparatus, necessary format conversion is performed to allow various actual robot apparatuses (or controllers) to be supported.
In the case of stopping formation the offset teaching point 107, a cancel button 210 at an upper right part of the parameter setting screen 20 in
As described above, the new offset teaching point 107 can be formed.
(Formation of Offset Teaching Point Using Base Coordinate System)
Next, the second case, that is, procedures and process for forming the offset teaching point 107 to perform offset by “−30 mm” in the Z-axis direction, by selecting the base coordinate system 104 from the teaching point 106 serving as the reference, are described with reference to
In
Next, the base coordinate system 104 is selected (coordinate system selecting unit; step S2).
As described above, selection of the teaching point 106 serving as the reference, and selection of the coordinate system to be used for input (base coordinate system 104) are finished, and preparation required to set the relative value that is the offset of the offset teaching point 107 is completed.
Next, the relative value to be the offset is set (parameter setting unit; S3).
The offset input value is equivalent to an example of the offset input of 30 mm downward using the tool coordinate system described above. The offset “30” has a different sign, because the tool coordinate system is used in the aforementioned example but the base coordinate system is used in this example, as the coordinate system used for input. That is, the positive value of 30 (mm) is input in the aforementioned example, because the front of the tool is typically defined as the positive direction of the Z-axis in the aforementioned tool coordinate system. The negative value of −30 (mm) is input in this example, because the positive direction (upper part of
In response to the numeric input into the relative value setting unit 202, the CPU 33 updates the content in a memory area corresponding to the relative value setting unit 202 arranged on, for example, the RAM of the storing apparatus 35. That is, when operation and input of changing a part of the position and orientation data through the operating input unit D are made, the part of the position and orientation data is changed according to the content of the operation and input (first calculating).
Subsequently, when the user presses the [Enter] key of the keyboard of the operating input unit D, the CPU executes the position and orientation calculation according to the function of the calculating unit 34 (orientation calculation unit).
First, it is herein determined whether the coordinate system selected is the tool coordinate system 105 or not (step S4 in
For example, in the case of the position and orientation calculation in the base coordinate system 104, calculation is performed according to procedures where the orientation matrix is divided into the position matrix and the rotation matrix, the calculation is then performed, and finally the product of the results of calculation is obtained.
First, the sum of the orientation matrix T1 of relative values from the base coordinate system 104 of the robot 101 to the teaching point 106 serving as the reference and the orientation matrix T2 of the relative values serving as offsets on the offset teaching point 107 is calculated, and an orientation matrix Ttmp1 is created (the following equation (3)). A rotation matrix Rtmp1 at this time is defined as 0.
Next, according to the orientation matrix T2 of the relative values that are the offset of the offset teaching point 107, an orientation matrix Ttmp2 where the position matrix P2 is defined as 0 is formed (the following equation (4)).
Next, according to the orientation matrix T1 of relative values from the base coordinate system 104 of the robot 101 to the teaching point 106 serving as the reference, an orientation matrix Ttmp3 where the position matrix P1 is defined as 0 is formed (the following equation (5)).
Next, according to the product of equations (3), (4) and (5), the orientation matrix T3 of relative values from the base coordinate system 104 of the robot 101 to the offset teaching point 107 is calculated (the following equation (6)).
T
3
=T
tmp1
·T
tmp2
·T
tmp3 (6)
Furthermore, an inverse kinematic calculation is applied to the calculation result of the equation (6) to calculate the articulation value of each axis of the robot 101. That is, in step S6, the CPU 33 performs position and orientation calculation that identifies the position or orientation of each part of the robot apparatus, based on a part of the position and orientation data (on the offset teaching point 107) changed in the first calculating. Based on the result of this position and orientation calculation, new position and orientation data (e.g., articulation value) is obtained (second calculating).
According to the position and orientation calculation described above, the offset teaching point 107 in the case of selecting the base coordinate system 104 can be obtained.
According to the control of
After the position and orientation calculation (step S6) in the base coordinate system, when no error occurs, the display of the virtual environment screen 10, the parameter setting screen 20 and additionally the management screen 40 of the displaying apparatus C is updated in step S9 in
That is, the CPU 33 updates the display of the display screen E of the displaying apparatus C, based on a part of the position and orientation data having been changed in the first calculating, and on the new position and orientation data having been calculated in the second calculating (display updating).
As described above, the base coordinate system 104 can be selected to form the offset teaching point 107. Upon formation of the offset teaching point 107, the display of the virtual environment screen 10, the parameter setting screen 20 and further the management screen 40 of the displaying apparatus C is updated. Consequently, the position and orientation and the parameters at the new offset teaching point 107 can be confirmed.
Consequently, even if the robot apparatus is actually not connected to the information processing apparatus A or if the actual robot apparatus is not operated, the user (operator) can confirm the validity of the input (edit) operation only by viewing the display screen E of the displaying apparatus C. Thus, the man-hour having conventionally been required to confirm the validity of the input (edit) operation can be reduced.
(Editing of Offset Teaching Point 107 and Switching Coordinate System)
Next, control in the third case, in which the formed offset teaching point 107 is edited and the coordinate system is switched, is described with reference to
Conventionally, in the case where necessity of switching the coordinate system occurs, the operator (user) performs matrix calculation to calculate parameters. Unfortunately, human errors, such as errors of inputting the calculated numeric values, sometimes occur. As described in this example, according to the configuration of calculating the relative value parameter in the coordinate system direction automatically switched when the coordinate system is switched, such human calculation errors can be reduced. The cases of switching the base coordinate system 104 and the tool coordinate system 105 are hereinafter described. First, processing in the case of switching the tool coordinate system 105 to the base coordinate system 104 is discussed.
The start of editing the offset teaching point 107 (step S12 in
Next, the tool coordinate system 105 is switched to the base coordinate system 104 (coordinate system selecting unit; step S13). For example, when the coordinate system selecting unit 204 on the parameter setting screen 20 in
When the system is switched to the base coordinate system 104 by the coordinate system selecting unit 204 on the parameter setting screen 20 (step S13 in
First, it is determined whether the selected coordinate system is the tool coordinate system 105 or not (step S4). When the base coordinate system 104 is selected here, the processing proceeds from step S4 to step S15, and calculation of the relative value of the base coordinate system 104 is executed (relative value calculating process; step S15).
In the relative value calculation of the base coordinate system 104, according to the equation (1), the orientation matrix T3 of relative values from the base coordinate system 104 to the offset teaching point 107 is calculated. Next, according to the equation (5), the orientation matrix Ttmp3 is calculated where the position matrix P1 of the orientation matrix T1 of relative values from the base coordinate system 104 to the teaching point 106 serving as the reference is defined as 0.
Subsequently, the product of inverse matrices of the equations (1) and (5) is calculated, and an orientation matrix Ttmp4 is calculated (the following equation (7)).
T
tmp4
=T
3·tmp3−1 (7)
Subsequently, an orientation matrix Ttmp5 is calculated where the position matrix of the orientation matrix Ttmp4 calculated according to the equation (7) is defined as 0 (the following equation (8)).
Subsequently, the product of inverse matrices of the orientation matrix Ttmp4 calculated according to the equation (7) and the orientation matrix Ttmp5 calculated according to the equation (8) is calculated, and an orientation matrix Ttmp6 is calculated (the following equation (9)).
[Expression 9]
T
tmp6
=T
tmp6·tmp5−1 (9)
Subsequently, from the rotation matrix Rtmp4 of the equation (7), the rotational components (α, β and γ) of the relative values that are the offset in the direction of the base coordinate system 104 are calculated. From the translational components Ptmp6 of the equation (9), the difference of the position matrix P1 of the orientation matrix T1 of relative values from the base coordinate system 104 of the robot 101 to the teaching point 106 serving as the reference is calculated, and the translational components (X, Y and Z) of the relative values which are the offset in the direction of the base coordinate system 104 are calculated.
Based on the relative values (X, Y, Z, α, β and γ) that are the offset in the direction of the base coordinate system 104, output according to the above calculation result, the CPU 33 updates the display screen E of the displaying apparatus C (displaying unit). As in this example, in the case of changing (only) the coordinate system, the position and orientation of the robot 101 are not changed. Update of the display screen E may be performed only for the relative value setting unit 202 (normality displaying process; step S9).
In the case of change (only) in coordinate system, it is a matter of course that the display of the position and orientation of the robot 101 on the virtual environment screen 10 is not necessarily changed.
Here, for example, with the position and orientation of the robot 101 displayed after teaching of the offset teaching point 107 in
Consequently, the display of the relative value setting unit 202 on the parameter setting screen 20 is the display in
After the user views and confirms the display screen E of the displaying apparatus C switched as described above, the editing of the offset teaching point 107 is finished in step S16.
As described above, according to this example, upon switching the coordinate system, the user (operator) can confirm the relative value parameter in the direction of the automatically switched coordinate system. Consequently, unlike the conventional case, the matrix calculation accompanied by the coordinate system transformation is not required to be manually performed. The man-hour and human errors can thus be reduced.
According to the control in the case of switching from the base coordinate system 104 to the tool coordinate system 105, transition occurs from step S4 to step S14 in
Also in switching from the base coordinate system 104 to the tool coordinate system 105, the base coordinate system 104 is switched to the tool coordinate system 105 using the coordinate system selecting unit 204 on the parameter setting screen 20 in step S13 in
In step S4 in
The relative value calculation in the tool coordinate system 105 calculates the orientation matrix T2 of relative values that are the offset of the offset teaching point 107 (the following equation (10)). Here, the orientation matrix T2 is obtained as the product of inverse matrices of the orientation matrix T3 that is the calculation result of the equation (6) and the orientation matrix T1 of relative values of the teaching point 106 serving as the reference in the base coordinate system 104 of the robot 101.
[Expression 10]
T
2
=T
3
·T
1
−1 (10)
Based on the result of calculation of the equation (10), Euler-angle transformation is performed, and the relative values (X, Y, Z, α, β and γ) that are the offset of the offset teaching point 107 in the direction of the tool coordinate system 105 are calculated.
Based on the relative values (X, Y, Z, α, β and γ) that are the offset and are output according to the calculation result, the CPU 33 updates the display screen E of the displaying apparatus C (displaying unit; step S9), and finishes the editing of the offset teaching point 107 (step S16).
It is the matter of course that in this display update, on the contrary to the case of the transformation to the base coordinate system, the parameter setting screen 20 is switched from the display of
As described above, even in the case of switching from the base coordinate system to the tool coordinate system, upon switching the coordinate system in a manner analogous to what has been described above, the user can immediately confirm the relative value parameter in the direction of the automatically changed coordinate system. Consequently, for example, the operator is not required to manually perform the matrix calculation. The man-hour and human errors can thus be reduced.
(Editing Teaching Point 106 Serving as Reference)
Finally, the process for the offset teaching point 107 in the case where the teaching point 106 serving as the reference is edited is described with reference to
It is assumed that on the parameter setting screen 20 for editing the teaching point 106 serving as the reference, the absolute value setting unit 201 and the relative value setting unit 202 are displayed (e.g.,
Consequently, in the hierarchically structured data, when the teaching point 106 serving as the reference is edited, the CPU 33 is required to change also the offset teaching point 107 while holding the relative value relationship.
The start of editing the teaching point 106 serving as the reference on the management screen 40 (step S17 in
Consequently, the CPU 33 switches the display of the teaching point name setting unit 212 on the parameter setting screen 20 to “P001” corresponding to the teaching point 106, reads the position and orientation data at the teaching point 106, and displays the data on the absolute value setting unit 201.
In this stage, the user corrects the position of the teaching point 106 serving as the reference by changing the numeric value in the absolute value setting unit 201 using the keyboard of the operating input unit D (step S18 in
In this embodiment, as described above, the teaching point 106 serving as the reference and the offset teaching point 107 are stored in the storing apparatus 35 according to the hierarchic node structure. Consequently, the CPU 33 recognizes that the teaching point 106 is the parent node, and the offset teaching point 107 is stored as a node affected by the parent node at the descendant of the parent node, through the storing format of the position and orientation data as described above and its content of data.
When the edit operation for the teaching point 106 serving as the reference is performed here, the position and orientation calculation is then performed also for the offset teaching point 107 according to the function of the calculating unit 34 of the CPU 33 (articulation value calculating process: S4 and S5 or S6 in
First, it is herein determined whether the coordinate system used for the description format of the offset teaching point 107 having a relationship of being a child model with respect to the teaching point 106 serving as the reference, is the tool coordinate system 105 or not (step S4 in
If the coordinate system describing the offset teaching point 107 is the tool coordinate system 105 in step S4, the processing proceeds to step S5. In step S5, based on the result of the correction of the teaching point 106 serving as the reference (step S18), the position and orientation calculation for the offset teaching point 107 in the tool coordinate system 105 is performed (step S5).
If the coordinate system describing the offset teaching point 107 is the base coordinate system 104 in step S4, the processing proceeds to step S6. In step S6, based on the result of the correction of the teaching point 106 serving as the reference (step S18), the position and orientation calculation for the offset teaching point 107 in the base coordinate system 104 is performed (step S6).
In step S5 or S6, the articulation value calculating process for each articulation of the robot 101 is also executed. If there are multiple offset teaching points 107 as child models in this case, the articulation value calculation for all the teaching points is performed.
Subsequently, the CPU 33 determines whether or not each articulation value of the robot 101 for achieving the offset teaching point 107 calculated in step S5 or S6 is within the limitation due to hardware or specifications (limitation determining process; step S7).
If each articulation value of the robot 101 is within the limitation in step S7, the CPU 33 updates the display screen E of the displaying apparatus C in step S9 (normality displaying process). At the same time, the display of the robot 101 on the virtual environment screen can be changed to have the position and orientation corresponding to the teaching point immediately (or when the teaching point is designated on the management screen 40).
On the other hand, if each articulation value of the robot 101 exceeds the limitation in step S7, the CPU 33 displays an error using the display screen E of the displaying apparatus C in step S19. As an example of this error display, a mark 108 (e.g., an x mark as illustrated in the diagram) is displayed at the teaching point 107 using the management screen 40 to indicate that the point is an unmovable teaching point as exemplified in
Here, the teaching point that is a child node of the teaching point 106 serving as the reference is only the teaching point 107 (P100). The CPU 33 can examine the relationship between another teaching point and the limitation range according to an analogous calculation process. Consequently, if there are other teaching points having the relationship of being a child node and any of the nodes is determined to be a teaching point out of the movable range, the CPU 33 displays the mark 108 for the teaching point as with in
The user having confirmed the display of the management screen 40 can determine the details of editing at the teaching point 106 serving as the reference, by clicking the determination button 209 (
For example, when a specific teaching point is selected on the management screen 40 after completion of the editing, the CPU 33 can change the display of the robot 101 on the virtual environment screen 10 to the position and orientation corresponding to this teaching point. When the teaching point is selected in the state where the mark 108 indicating immobility is displayed on the management screen 40, the CPU 33 notifies the user of an error by displaying, for example, the error screen 50 (
As described above, the teaching point 106 serving as the reference can be edited and corrected. As described above, in this embodiment, for example, the offset teaching point 107 is stored in the hierarchic node format at the node having a relationship of being a child of the teaching point 106 serving as the reference. Consequently, when the teaching point 106 is changed, the CPU 33 can immediately, automatically execute the position and orientation calculation for the teaching point 107, and causes the display screen E to reflect the result.
Therefore, the user can confirm the effect pertaining to the position and orientation at the associated offset teaching point 107 in real time during the editing process only by editing the teaching point 106 serving as the reference, thereby allowing the operation man-hour to be reduced.
As described above, according to this embodiment, in inputting and editing the position and orientation data on the robot apparatus in the information processing apparatus A, the operator can easily form and edit the offset teaching point 107 and the teaching point 106 serving as the reference and switch the coordinate system. In this embodiment, the position and orientation calculation for the robot apparatus is automatically executed based on the edit result. The result is immediately reflected in the display screen E of the displaying apparatus C, the numeric value display on the parameter setting screen 20, the position and orientation display on the virtual environment screen 10, and the management display on the management screen 40. Consequently, the user can confirm the validity of input and editing of the position and orientation data on the robot apparatus having now been executed, through the display screen E of the displaying apparatus C, without performing complicated manual calculation. The operation man-hour and human errors can be reduced accordingly.
This embodiment adopts the data structure for storing the nodes of the position and orientation data that is the robot control data (teaching data) in the storing apparatus 35 according to the hierarchic tree structure. For example, the data items having a relationship between a parent and a child, such as the offset teaching point and the teaching point serving as the reference, are not stored in a conventional, simple and flat data structure, but are stored in the storing apparatus according to the hierarchic node structure instead. Consequently, when the position and orientation data is input, edited or corrected, the range of the affected position and orientation data can immediately be identified, and the error checking on trajectory calculation for the position and orientation data in the range can be performed.
This embodiment adopts the tree-structured storing format that hierarchically arranges the nodes of the position and orientation data. Consequently, during the processes of inputting, editing and correcting the position and orientation data on the teaching point, a part to be updated can be swiftly and securely identified in, for example, the virtual display output, numeric value display, and management display. The virtual display output, numeric value display, and management display can be updated so as to allow the progress of input, edit and correction being executed to be confirmed in real time substantially according to the operation as it is.
According to this embodiment, in input, edit or correction of the position and orientation data, the position and orientation data can be designated through a relative value that is an offset, and a robot coordinate system that is easily grasped can arbitrarily be selected among multiple robot coordinate systems and used. If the position and orientation data is input and edited according to the offset relative value, the position and orientation calculation in conformity with the input and editing is executed using the storing format of the hierarchic node structure, which can swiftly and securely update, for example, the virtual display output, numeric value display, and management display.
Two types which are the base coordinate system 104 and the tool coordinate system 105 have been described above as selectable coordinate systems. Alternatively, for the aimed robot apparatus, another coordinate system, for example, a coordinate system with reference to another specific part of the robot is sometimes used. In this case, coordinate systems other than the base coordinate system 104 and the tool coordinate system 105 may be adopted as alternatives of the coordinate systems. For example, in the case where there are two robots 101 and these two robots 101 operate in collaboration with each other, a configuration can be considered where the base coordinate system 104 and the tool coordinate system 105 of the other robot 101 are selectable to support the operation of the other robot 101. In the case of presence of a work coordinate system with reference to the origin of the work 103, the GUI of the display screen E can be designed to allow the work coordinate system to be selectable. Variation examples related to these coordinate systems are also executable in each of embodiments, which will be described later.
Some different embodiments are hereinafter described for the information processing apparatus and the information processing method of the present invention. Hereinafter, the same reference signs are used for the same configuration elements. The detailed description of the elements is omitted. In the control procedures illustrated in a flowchart, described later, the same step numbers are used for steps equivalent to the steps in
An information processing apparatus and an information processing method according to Embodiment 2 of the present invention are hereinafter described with reference to
In Embodiment 1 described above, the teaching point 106 serving as the reference is, for example, the teaching point represented by the relative value of the robot 101 from the base coordinate system 104. In this case, for example, when the position and orientation of the work 103 are changed, changing of the position and orientation of the work 103 in the virtual environment and editing of the position and orientation of the associated teaching point 106 serving as the reference are additionally required. Consequently, automatic editing of the position and orientation of the teaching point 106 serving as the reference according to the change of the position and orientation of the work 103 is convenient.
Thus, this embodiment exemplifies a method of managing the teaching point 109 serving as the reference and the offset teaching point 110 (
In the process of editing the offset teaching point 110 associated with the work 103, processes and display different according to GUI selecting procedures on the display screen E of the displaying apparatus C are performed. For example, as to editing of teaching point information associated with the work 103, two cases which are “the case of editing the offset teaching point 110” and “the case of editing the work 103” are hereinafter described.
As to the “the case of switching the coordinate system” and “the case of editing the teaching point 106 serving as the reference”, which have been described in Embodiment 1, processes analogous to the processes in Embodiment 1 are performed.
(Process of Editing Offset Teaching Point 110 Associated with Work 103)
First, the first case, that is, edit procedures and processes on the offset teaching point 110 associated with the work 103 are described with reference to
As to the teaching data corresponding to the management screen 40 in
As illustrated in
Here, the teaching point 109 serving as the reference of the work 103 corresponds to the position and orientation data on a specific part, for example, a position for grasping the work 103 by the robot 101. The offset teaching point 110 has the position and orientation represented by an offset relative value with respect to the position and orientation of the teaching point 109 serving as the reference.
The teaching point 109 serving as the reference and the offset teaching point 110 are stored in the storing apparatus 35 according to a hierarchic node structure as with the case of the teaching point 106 serving as the reference and the offset teaching point 107 in the above embodiment. Consequently, editing and display control related to the editing which are analogous to those on the teaching point 106 serving as the reference and the offset teaching point 107 in the above embodiment can be executed.
The offset teaching point 110 is edited according to procedures exemplified as follows.
In step S12 in
As illustrated in
Next, the relative value that is the offset of the offset teaching point 110 can be edited using the relative value setting unit 202 on the parameter setting screen 20. (Parameter Setting Unit; step S3). When the user inputs or edits the relative value that is the offset of the offset teaching point 110 using the relative value setting unit 202, position and orientation calculation accompanied by coordinate system transformation is performed according to the function of the calculating unit 34 of the CPU 33.
First, in step S21, the CPU 33 determines whether the teaching point is associated with the work 103 or not (model determination process; step S21). This determination corresponds to the process of searching for the teaching point data in the hierarchic node structure as in
In this example, it is determined that the teaching point 110 is a teaching point associated with the work 103 in step S21, and then step S22 is executed. In step S22, the relative value from the base coordinate system 104 of the robot 101 to the teaching point 109 serving as the reference is calculated (base relative value calculating process).
Here, as represented in the following equation (11), based on the product of the orientation matrix T4 of absolute values from the absolute coordinate system to the work 103 and the orientation matrix T5 of relative values from the work 103 to the teaching point 109 serving as the reference, an orientation matrix Ttmp7 of absolute values of the teaching point 109 serving as the reference from the absolute coordinate system is calculated.
T
tmp7
=T
4
·T
5 (11)
Next, as represented in the following equation (12), based on the product of calculation result of the equation (11) and the inverse matrix of the orientation matrix T6 of absolute values from the absolute coordinate system to the base of the robot 101, the orientation matrix T1 of relative values from the base coordinate system 104 of the robot 101 to the teaching point 109 serving as the reference is calculated.
T
1
=T
tmp7
·T
6
−1 (12)
Following step S22, alternatively, when the processing target teaching point is the teaching point associated with the base coordinate system 104 of the robot 101 in step S21, the process of step S4 is executed. In step S4, the CPU 33 determines whether the coordinate system selected on the coordinate system selecting unit 204 on the parameter setting screen 20 (e.g.,
When the coordinate system selected in step S4 is the tool coordinate system 105, the processing proceeds to step S5, and the position and orientation calculation process for each articulation of the robot 101 in the tool coordinate system 105 is executed, as with the case of Embodiment 1 (articulation value calculating process; step S5).
On the other hand, when the coordinate system selected in step S4 is the base coordinate system 104, the processing proceeds to step S6, and the position and orientation calculation process for each articulation of the robot 101 in the base coordinate system 104 is executed, as with the case of Embodiment 1 (articulation value calculating process; step S6).
Next, after step S7, the display on the display screen E is updated according to the result of the position and orientation calculation in step S5 or S6 (displaying unit).
First, in step S7, the CPU 33 determines whether each articulation value of the robot 101 required for the case of moving the reference part to the offset teaching point 110 is within the limitation defined by the hardware, specifications and regulations or not (limitation determining process; step S7), as with Embodiment 1.
If each articulation value of the robot 101 is within the limitation in step S7, the processing proceeds to step S9 and the CPU 33 updates the display screen E of the displaying apparatus C according to the result of the position and orientation calculation (normality displaying process). At the same time, the display of the robot 101 on the virtual environment screen 10 can immediately be changed to have the position and orientation corresponding to the teaching point 110.
On the other hand, if each articulation value of the robot 101 exceeds the limitation in step S7, the processing proceeds to step S8, the error screen 50 in
Subsequently, the user having viewed the display of the robot 101 on the virtual environment screen 10 and the display on the parameter setting screen 20 can determine the details of editing at the teaching point 110 serving as the reference, by clicking the determination button 209 (
As described above, upon performing the operation of editing the offset teaching point 110 associated with the work 103, the user can immediately confirm the position and orientation of the robot 101 and the parameter of the teaching point. Consequently, human errors and the operation man-hour can be reduced.
(Change in Placement of Work 103)
Next, the second case, which is the edit process of changing the placement of the work 103, and a control example by the CPU 33 associated therewith, are described with reference to
The display illustrated in
The nodes of the teaching point 109 serving as the reference and the offset teaching point 110 of the child store the position and orientation data corresponding to the position and orientation of the reference part of the robot 101, e.g., in the case of handling, such as grasping, of the work 103. In this example, the nodes of the teaching points 109 and 110 are stored in the hierarchic layer of the work 103. Consequently, when the position of the work 103 is changed, the CPU 33 can automatically edit (change) the nodes of the teaching points 109 and 110 which are affected as described below.
The position and orientation data for controlling the robot apparatus in this specification is stored in the storing apparatus 35 according to the hierarchic node structure. For example, the associated teaching point (e.g., the teaching point as the reference, and the offset teaching point) is hierarchically correlated, and stored as nodes. Consequently, when editing for a specific node is performed, another node in the range affected by the editing can immediately be identified. The new value of the node can be calculated according to the edited node.
A target other than the robot 101, for example, (the position and orientation data of) the work 103, can also be stored as one node in the storing apparatus 35 according to the hierarchic data structure. Consequently, when (the position and orientation data of) the node of the work 103 dealt with by the robot 101 is edited, the relationship with the limitation due to the hardware, specifications and regulations can be checked by calculating the position and orientation of the robot 101 as described above. If no error occurs, the display of the parameter setting screen 20 and the virtual environment screen 10 on the display screen E can be updated.
As to hierarchic data storage on the storing apparatus 35 pertaining to the work 103, a state is considered where the teaching point 109 serving as the reference and the offset teaching point 110 are associated with each other (e.g.,
In step S23 in
When the node of the work 103 is clicked on the management screen 40 to select the node in step S23, the CPU 33 switches the parameter setting screen 20 to, for example, the state illustrated in
If the work 103 has already been placed at this stage, X, Y and Z coordinate values where the work 103 is placed on the absolute value setting unit 201 are displayed as illustrated in
Subsequently, in step S24 in
In the example of GUI in
A numeric value of “300” (mm) is input into the X-axis setting field 208 of the relative value setting unit 202 through the keyboard of the operating input unit D, and the [Enter] key of the keyboard is pressed (the numeric value before the input is “400”). The [Enter] key of the keyboard is pressed here in the case of editing the node of the work 103, the CPU 33 copies the input made into the relative value setting unit 202 to the absolute value setting unit 201 to display the input, as illustrated in
It is assumed here that the change in placement of the work 103 through the designation of the numeric value is made by an operation of moving the work 103, for example, from the position in
When the input is made into one of the input fields for the nodes and the [Enter] key is pressed as described above, the CPU 33 changes the position and orientation data on the node according to the details of editing, and calculates the new position and orientation of the teaching point of the node affected by this editing.
In the case where the work 103 and the teaching points 109 (P010) and 110 (P110) are stored according to the node structure as illustrated in
First, in step S21 in
For example, in the case of the teaching point 109 serving as the reference and the offset teaching point 110, the points are stored in the nodes at the descendants of the work 103. Consequently, step S22 is executed. In step S22, the relative value from the robot 101 in the base coordinate system (104) to the teaching point 109 serving as the reference is calculated (base relative value calculating process; S22).
The subsequent steps S4 to S6 are determination processes for the coordinate system pertaining to the data representation of the processing target teaching point as have been illustrated in
First, in step S4, it is determined whether the coordinate system indicated by the coordinate system data stored together with the position and orientation data on the teaching point is the tool coordinate system 105 or not.
If the determination result of step S4 indicates the tool coordinate system 105, the processing proceeds to step S5, and orientation calculation for the tool coordinate system 105 is executed in a manner analogous to the description with reference to
If the determination result of step S4 indicates the base coordinate system 104, the processing proceeds to step S6, and orientation calculation for the base coordinate system 104 is executed in a manner analogous to the description with reference to
Subsequently, based on the result of the position and orientation calculation, the display on the display screen E of the displaying apparatus C is updated (displaying unit). In step S7, it is determined whether each articulation value required to move the reference part of the robot 101 to the teaching point 109 serving as the reference and the offset teaching point 110 is within the limitation defined by the hardware, specifications and regulations or not (limitation determining process).
If the determination in step S7 indicates that the position and orientation of the robot 101 (the state of each articulation value) are within the limitation, the processing proceeds to step S9 and the CPU 33 updates the display screen E of the displaying apparatus C according to the result of the position and orientation calculation (normality displaying process).
After the user views and confirms the display screen E of the displaying apparatus C having been switched as described above, the user clicks the determination button 209 on the parameter setting screen 20 using the mouse of the operating input unit D. According to this operation, the CPU 33 finishes editing the teaching points 109 and 110 in step S25. When the cancel button 210 on the parameter setting screen 20 is clicked by the mouse of the operating input unit D, the CPU 33 discards the details of editing and returns the virtual environment screen 10 to the screen in the state of
Furthermore, it is configured that after editing on changing the placement of the work 103 is completed, the teaching point 109 serving as the reference and associated with the work 103 on the management screen 40 is allowed to be selected by clicking through the mouse. According to the operation of selecting the teaching point 109, the CPU 33 can display, on the virtual environment screen 10, the position and orientation of the robot 101 in the state of having been moved to the teaching point 109 serving as the reference.
As described above, according to this embodiment, the robot teaching data is stored according to the tree structure that hierarchically stores the nodes.
Accordingly, the teaching points 109 and 110 can be stored at the descendants of the node of the work 103.
Consequently, when the position and orientation of the node of the work 103 are changed, the CPU 33 can automatically calculate the position and orientation data on the teaching points 109 and 110 that are associated descendant nodes, and automatically calculate the position and orientation (and each articulation value achieving the position and orientation) of the robot 101. Furthermore, the CPU 33 can determine whether the position and orientation (and each articulation value achieving the position and orientation) of the robot 101 are within the limitation defined by the hardware, specifications and regulations or not.
The case of unavailable position and orientation of the robot 101 at the teaching points 109 and 110 after the placement of the work 103 is changed is described.
For example,
The change in the position of the work 103 in the X-axis direction by “500” (mm) is a larger movement than the movement in the case of “300” (mm) in
Consequently, if the position of the work 103 is changed in the X-axis direction by “500” (mm), the processing transitions from step S7 (limitation determining process) to step S19 (abnormality displaying process) in
It can be considered that the virtual environment screen 10 in the case where the placement change of the work 103 with unavailable position and orientation of the robot 101 is performed may be updated as illustrated in
When the edit process pertaining to the placement change of the work 103 is performed in the state in
At a stage where the position and orientation calculation pertaining to the edit operation is finished and the processing enters the determination for the limitation range, the processing transitions from step S7 (limitation determining process) to step S19 (abnormality displaying process) in
As described above, the data structure for storing the nodes of the position and orientation data that is the robot control data (teaching data) of this embodiment in the storing apparatus 35 according to the hierarchic tree structure is adopted. According to this structure, not only the position and orientation data pertaining to the robot apparatus but also the position and orientation data pertaining to the work 103 can be stored in the same tree structure as described above. Consequently, when the editing pertaining to the work 103 is performed in the case where the tree-structured teaching data items include other associated teaching data items (e.g., the teaching point 109 and the offset teaching point 110 of the work 103), these associated teaching data items can immediately, automatically be recalculated. The position and orientation calculation of the robot 101 is performed according to the editing pertaining to the work 103. This calculation can automatically execute checking of the validity on the limitation defined by the hardware, specifications and regulations.
If no problem occurs as a result of the recalculation of the teaching data and the position and orientation of the robot 101, the display screen that includes the virtual environment screen 10, the parameter setting screen 20, and the management screen 40 of the displaying apparatus C can automatically be updated to the details according to the edit operation, immediately after editing. Consequently, the user (operator) can confirm the details of editing associated with the work 103 and the result in real time, which can reduce human errors and the man-hour.
The teaching point 106 serving as the reference, and the offset teaching point 107 are stored at the descendant of the node of the robot 101 (ROBOT) in
In this case, a configuration is convenient where the teaching points 106 and 109 and the teaching points 107 and 110 corresponding to each other have a relationship where editing one teaching point causes the details of the other corresponding teaching point to be automatically edited in the same manner. According to a method of allowing such a process, for example, the entities of the corresponding teaching points 106 and 109 (or the teaching points 107 and 110) are stored on the same memory cell in the storing apparatus 35. The address pointer of this one memory cell is stored as nodes P001 and P100 (or P010 and P110) in the trees of ROBOT and Work. According to such a structure, any designation of editing can edit the actual data stored in the same memory cell via any of the pointers of the nodes P001 and P100 (or P010 and P110).
Through use of the structure of accessing the entity of the same memory data via different multiple pointers (and names), alias nodes can be prepared as necessary at different positions in the tree structure where the teaching data is stored. Consequently, the user can easily grasp the structure of the entire robot control data, reach one identical data from different multiple positions in the tree structure, and securely edit the content of the data.
The configuration of accessing the entity of the identical data via different multiple names is not limited to the address pointer. For example, any of the mechanisms of “links”, such as a junction, a symbolic link and a hard link, which are used in various file systems may be utilized. In this case, a specific node is stored as one file in the file system arranged in the storing apparatus 35, and the link is arranged as another node on another position on the tree of the data structure.
An information processing apparatus and an information processing method according to Embodiment 3 of the present invention are hereinafter described with reference to
In the above Embodiments 1 and 2, the process of editing the relative value that is the model information from the parent to the child on a node-managed working space has been described. However, editing is not necessarily set according to the relative value.
For example, when a complicated operation is taught during formation of the offset teaching point 107 through selection of the tool coordinate system, setting should sometimes be made according to an absolute value in an absolute coordinate system (e.g., the base coordinate system), such as on the working space, in some situations.
A process is described that operates the offset teaching point 107 and the offset teaching point 110 through an absolute value using an absolute coordinate system on the working space by operating the absolute value setting unit 201 of the parameter setting screen 20.
As to the edit process through the operation of the absolute value setting unit 201, different processes and display are required to be performed according to the types of target teaching points. Consequently, three cases are hereinafter described that are “the case of the offset teaching point 107 in the tool coordinate system 105 being selected”, “the case of the offset teaching point 107 in the base coordinate system being selected”, and “the case of the offset teaching point 110”.
(Absolute Value Editing on Offset Teaching Point 107 in Tool Coordinate System 105 Being Selected)
First, the first case, that is, procedures and control of editing the absolute value of the offset teaching point 107 in the tool coordinate system 105 being selected are described with reference to
In step S12 in
In setting of the numeric value of the parameter, the parameter setting screen 20 as illustrated in
In step S26 in
At the stage of
Subsequently, the user changes the content of the X-axis setting field 208 of the absolute value setting unit 201 from “400” to “300” as illustrated in
First, in step S21 in
In step S4, it is determined whether the coordinate system selected for the teaching point (107) is the tool coordinate system 105 or not (S4). When the coordinate system selected here is the tool coordinate system 105 as illustrated in
Subsequently, in step S5, in a manner analogous to the description of Embodiment 1 with reference to
First, in step S7, it is herein determined whether each articulation value on the offset teaching point 107 is within the limitation defined by the hardware, specifications and regulations or not (limitation determining process). If the value is within the limitation in step S7, the processing proceeds to step S9 and the CPU 33 updates the display screen E of the displaying apparatus C according to the result of the position and orientation calculation (normality displaying process).
According to the details of updating, the display updating is performed so that the relative values (X, Y, Z, α, β and γ) that are offsets in the direction in the tool coordinate system 105 are reflected in the relative value setting unit 202, and the result of calculation of the articulation value on each axis of the robot 101 obtained by the inverse kinematic calculation is reflected on the virtual environment screen 10.
If the value is out of the limitation in step S7, the processing proceeds to step S8, the error screen 50 in
The method of using the determination button 209 and the cancel button 210 on the parameter setting screen 20 at the time when the editing in step S16 in
As described above, even when the parameter of the absolute value at the offset teaching point 107 in the base coordinate system being selected is changed, the operator can immediately confirm the position and orientation and the parameter of the relative value concurrently with the absolute value editing operation, thereby allowing the man-hour required for confirmation to be reduced. That is, according to discussion also in consideration of the Embodiment 1, in editing the offset teaching point 107, this system can appropriately execute editing of the offset teaching point 107, and updating of the display screen E based on the editing, in any of the cases of using the relative value and using the absolute value.
(Absolute Value Editing on Offset Teaching Point 107 in Base Coordinate System 104 Being Selected)
Next, the second case, that is, editing on the absolute value of the offset teaching point 107 in the base coordinate system 104 being selected is described with reference to
The offset teaching point 107 on the management screen 40 (
The absolute value editing operation performed in this example is equivalent to the absolute value editing on the offset teaching point 107 in the tool coordinate system being selected. Consequently, the display in
In this example, in setting of the numeric value of the parameter, the parameter setting screen 20 as illustrated in
In step S26 in
At the stage of
Subsequently, the user changes the content of the X-coordinate value setting field 208 of the absolute value setting unit 201 from “400” to “300” as illustrated in
First, in step S21 in
In step S4, it is determined whether the coordinate system selected for the teaching point (107) is the tool coordinate system 105 or not (S4). When the coordinate system selected here is the base coordinate system 104 as illustrated in
Subsequently, in step S6, in a manner analogous to the description of Embodiment 1 with reference to
Subsequently, in step S7, it is determined whether each articulation value on the offset teaching point 107 is within the limitation defined by the hardware, specifications and regulations or not (limitation determining process). If the value is within the limitation in step S7, the processing proceeds to step S9 and the CPU 33 updates the display screen E of the displaying apparatus C according to the result of the position and orientation calculation (normality displaying process).
According to the details of updating, the display updating is performed so that (X, Y, Z, α, β and γ) which are offsets in the direction in the base coordinate system 104 are reflected in the relative value setting unit 202, and the result of calculation of the articulation value on each axis of the robot 101 obtained by the inverse kinematic calculation is reflected on the virtual environment screen 10.
If the value is out of the limitation in step S7, the processing proceeds to step S8, the error screen 50 in
The method of using the determination button 209 and the cancel button 210 on the parameter setting screen 20 at the time when the editing in step S16 in
As described above, even when the parameter of the absolute value at the offset teaching point 107 in the base coordinate system being selected is changed, the operator can immediately confirm the position and orientation and the parameter of the relative value concurrently with the absolute value editing operation, thereby allowing the man-hour required for confirmation to be reduced. In consideration together with the above example, in editing the offset teaching point 107, this system can significantly easily edit the teaching data through equivalent operations of the offset teaching point 107 in the representation both in the tool coordinate system and the base coordinate system. Based on the edit operation, update of the display screen E can appropriately be executed immediately according to the details of editing.
(Absolute Value Editing on Offset Teaching Point 110 Associated with Work 103)
Next, the last case pertaining to the absolute value editing, that is, the editing on the absolute value on the offset teaching point 110 associated with the work 103 is described. The editing on the absolute value on the offset teaching point 110 is basically equivalent to the case of editing the absolute value on the offset teaching point 107 described above. Consequently, points different from the points of the two types of absolute value editing, described above, are mainly described.
Control of the editing of the absolute value on the offset teaching point 110 associated with the work 103 may be according to the control procedures in
First, the procedures where the offset teaching point 110 on the management screen 40 (
Here, for example, the teaching point 109 serving as the reference and the offset teaching point 110 are equivalent to the teaching point 106 and the offset teaching point 107 on the robot side serving as the reference in the above embodiment, respectively. In this case, the arrangement of the numeric values in the absolute value setting unit 201 in
In step S26 in
Subsequently, in step S21 in
Control of transition to the relative value calculation in the base coordinate system in step S22 advances in a manner analogous to the control of the example of editing the absolute value associated with the offset teaching point 107.
As described above, according to this system, the changing of the parameter of the absolute value on the offset teaching point 110 associated with the work 103 can be performed in a manner analogous to the case of the offset teaching point 107 in the node tree of the robot 101. Also in this case, the operator can immediately confirm the position and orientation and the parameter of the relative value concurrently with the absolute value editing operation. Consequently, the man-hour required for the confirmation can be reduced.
In consideration together with the above example, this system can significantly easily edit the teaching data through equivalent operations both in the cases of the offset teaching point 110 that is in the node tree of the work 103 and the offset teaching point 107 that is in the node tree of the robot 101. Based on the edit operation, update of the display screen E can appropriately be executed immediately according to the details of editing.
An information processing apparatus and an information processing method according to Embodiment 4 of the present invention are hereinafter described with reference to
Embodiments 1 to 3 describe the operation method of editing the position and orientation data on the teaching point as the robot control data (teaching data) through numeric input of the relative value or the absolute value using the parameter setting screen 20.
As another operation method related to input and editing of the position and orientation data, a GUI operation unit can be considered to be provided. The GUI operation unit changes the position and orientation of the robot 101 displayed on the virtual environment screen 10 in relation to the operating input unit D (or the virtual environment screen 10). In this case, according to change in the position and orientation of the robot apparatus through an operating unit of the operating input unit D, the virtual display of the robot 101 on the virtual environment screen 10 can be updated, and the content of the numeric value display on the parameter setting screen 20 can be updated.
As illustrated in
A configuration and control for input and editing of the position and orientation data using the operation handle 111, described above, in the information processing apparatus A are hereinafter described with reference to
In this embodiment, the offset teaching point 107 is edited by the operation handle 111 operating the virtual display of the robot 101. For such editing, first, the user selects the offset teaching point 107 on the management screen 40 (
Subsequently, in step S27, the user operates the operation handle 111 using the cursor (pointer) of the mouse of the operating input unit D, and changes the position and orientation of the robot 101. The operation handle 111 is displayed in a manner overlaid on a distal part of the robot 101, for example, as illustrated in
As to the display object of the operation handle 111, for example, the operation handle 111 may be a ring-shaped object graphically configured so as to display the coordinate system direction of the offset teaching point 107 being currently set.
The operation handle 111 may be configured so that this handle can substantially linearly be clicked and dragged on the screen using the cursor (pointer) of the mouse of the operating input unit D. In this case of clicking and dragging operations, for example, a reference part set at the center of the flange surface where the tool 102 at the distal end of the robot 101 is arranged is moved to any position in the three-dimensional space represented on the virtual environment screen 10.
In the case of operating the offset teaching point 107 through the moving operation by the operation handle 111, as in this embodiment, for example, the reference part of the robot 101 is associated with the offset teaching point 107. In this case, control by the CPU 33 is performed so that when the offset teaching point 107 is operated, the reference part of the robot 101 associated with the offset teaching point 107 is moved, and the position and orientation of the robot 101 is changed in synchronization with the movement.
To operate the offset teaching point (107) through the operation handle 111 as in this embodiment, it is useful that the (amount of) movement designated by the operation handle 111 is associated with one of an absolute value and a relative value. Here, the “relative value” is the coordinate value (position and orientation data) in the relative coordinate system, such as the tool coordinate system 105. The “absolute value” is the coordinate value (position and orientation data) in the absolute coordinate system, such as the base coordinate system 104.
For example, if the relative value (or an absolute value) has already been assigned with the teaching point selected at the time of start of the procedures in
Hereinafter, for the sake of convenience, as described above, the operation handle 111 controlled in a state where a relative value is input is called “relative value handle”, and the operation handle 111 controlled in a state where an absolute value is input is called “absolute value handle”.
When the moving operation through the operation handle 111 described above, is performed, the CPU 33 executes the position and orientation calculation that changes the angle of each articulation of the robot 101 according to the position of the movement destination of the offset teaching point 107 (reference part). The CPU 33 changes the position and orientation of the robot 101 displayed on the virtual environment screen 10 according to the result of the position and orientation calculation. The details of GUI through use of the operation handle 111, described above, are of a known-technique. Consequently, more detailed description than the above description is omitted.
In
The operation handle 111 may always be displayed on the virtual environment screen 10. Alternatively, this handle may be displayed only at a necessary timing according to the setting operation through the operating input unit D (e.g., designating an operation mode, such as a virtual environment operation mode or a three-dimensional operation mode).
In step S27, the user can change the position and orientation of the robot 101 displayed on the virtual environment screen 10, using the operation handle 111, as described above. At this time, according to the moving operation through use of the operation handle 111, the CPU executes the position and orientation calculation according to the moving operation, and changes the position and orientation of the robot 101 according to the calculation result.
A screen updating method may be considered that is executed for every minute operation of the operation handle 111, for example, to change the position and orientation of the robot 101 according to the position and orientation calculation result. Alternatively, a method may be adopted that only moves parts, such as the cursor (pointer) of the mouse and the operation handle 111, displayable in a small screen range during the moving operation, and draws the position and orientation of the entire robot 101 in response to a mouse releasing operation.
In step S27, the CPU 33 executes the moving operation, the position and orientation calculation (orientation calculation unit), and the updating of drawing of the virtual environment screen 10, at least for the parts according to the minute operation of the operation handle 111 described above.
The control procedures in
In step S28, the CPU 33 determines whether the current operation handle 111 is the relative value handle (or absolute value handle). If the operation handle 111 indicates a vector in the direction of the tool coordinate system 105 in step S28, that is, in the case of the relative value handle, the processing proceeds to step S29. In step S29, the CPU 33 executes calculation by adding the amount of movement in the vector direction selected by the mouse to the relative value from the teaching point 106 serving as the reference to the offset teaching point 107, and obtains the calculated value as the relative value after movement.
On the other hand, if the operation handle 111 is displayed as the absolute value handle in the direction of the absolute coordinate system (e.g., base coordinate system 104) in step S28, the processing proceeds to step S30. In step S30, the CPU 33 executes calculation by adding the amount of movement in the vector direction selected by the mouse to the absolute value from the absolute coordinate system to the offset teaching point 107, and obtains the calculated value as the absolute value after movement.
As described above, the value (relative value or absolute value) on the offset teaching point 107 after movement is input. Subsequent to step S29 or S30, it is determined whether this teaching point is a teaching point associated with the work or not in step S21. If the step S21 is positive, calculation of relative value transformation for the base coordinate system of the robot is executed in step S22. The subsequent steps on and after step S4 in
If no limitation error occurs, (final) updating of the display screen E of the displaying apparatus C is executed according to the result of calculation. That is, according to change in the position and orientation of the robot 101 through the operation handle 111, the virtual display of the robot 101 on the virtual environment screen 10 is subjected to (finally) updating, and the content of the numeric value display on the parameter setting screen 20 is updated. The position and orientation of the robot 101 indicated by solid lines in
As described above, according to this embodiment, as another operation method related to input and editing of the position and orientation data, a GUI operation unit is provided. The GUI operation unit changes the position and orientation of the robot 101 virtually displayed in relation to the operating input unit D (or the virtual environment screen 10). The user can perform the input and edit operation that changes the position (orientation) of the robot 101 (and the teaching point associated with the robot) through a significantly intuitive operation on the virtual environment screen 10 using the operation handle 111. The result of the input and edit operation on the virtual environment screen 10 is synchronously reflected in the virtual display of the robot 101 on the virtual environment screen 10 and also in the content of the numeric value display on the parameter setting screen 20. Consequently, the user (operator) can immediately confirm the position and orientation and the parameter concurrently with operating the operation handle 111, for example. The man-hour required for the confirmation can thus be reduced.
In Embodiments 1 to 4 described above, in the case where the position and orientation data is represented in the three-dimensional coordinates (and further in angles about axes) in a specific coordinate system corresponding to, for example, a working space, the input and edit process that changes the content represented in the relative value or absolute value has been described.
However, in some cases, the edit of the position and orientation data is desired to be performed through an interface that directly changes the articulation values in the articulation space of the robot 101, instead of the relative value and absolute value of the position and orientation data (three-dimensional coordinates and angles about axes) as described above.
For example, based on the state where the robot 101 has a specific orientation, the user (operator) can sometimes, intuitively, easily understand the operation of rotating specific one (or more) articulation(s) from the orientation for the purpose of, for example, avoiding an obstruction.
In this case, as described below, as illustrated in, for example,
Control in the case of inputting and editing the offset teaching point 107 using the articulation value setting unit 211 prepared on the parameter setting screen 20 is hereinafter described with reference to
First, in step S12 in
The parameter setting screen 20 in
In
The articulation value setting unit 211 on the parameter setting screen 20 is a numeric input field that, for example, receives and displays the articulation values (rotation angles) of six articulations. These articulation values have angles corresponding to the position and orientation on the offset teaching point 107 according to the articulation value calculation described above.
In step S31 in
Subsequently, in step S7, the CPU 33 determines whether each of the set articulation values is within the limitation defined by the hardware, specifications and regulations or not (limitation determining process). If the value is determined to be out of the limitation here, the processing proceeds to step S8, the error screen 50 in
If the value is within the limitation in step S7, the processing proceeds to step S32, and the position and orientation calculation is performed according to the function of the calculating unit 34 of the CPU 33 (orientation calculation unit). Here, the relative value from the base coordinate system 104 of the robot 101 to the offset teaching point 107 is calculated based on the articulation value of each axis of the robot 101 according to forward kinematic calculation.
Subsequently, in step S33, the absolute value from the absolute coordinate system (e.g., base coordinate system) to the offset teaching point 107 is calculated (absolute value calculation process). For example, as represented in the following equation (13), an orientation matrix T7 of the absolute value from the absolute coordinate system to the offset teaching point 107 is obtained, based on the product of the orientation matrix T6 of the absolute value from the absolute coordinate system to the base coordinate system 104 of the robot 101 and the orientation matrix T3 that is the result of calculation in S31. According to the equation (13), Euler-angle transformation is performed, and the absolute values (X, Y, Z, α, β and γ) on the offset teaching point 107 are calculated.
T
7
=T
6
·T
3 (13)
Next, in step S4, it is determined whether the selected coordinate system is the tool coordinate system 105 or not. When the selected coordinate system is the tool coordinate system 105, the processing proceeds to step S14, and the relative value calculation in the tool coordinate system 105 is executed (relative value calculating process). When the selected coordinate system is the base coordinate system 104, the processing proceeds to step S15, and the relative value calculation in the base coordinate system 104 is executed (relative value calculating process).
After the relative value calculation in step S14 or S15, the CPU 33 updates the display screen E of the displaying apparatus C according to the result of calculation (normality displaying process). In the updating of the display screen E, the calculated absolute values (X, Y, Z, α, β and γ) are displayed on the absolute value setting unit 201 on the parameter setting screen 20. The content of the relative value setting unit 202 on the parameter setting screen 20 is updated so as to display the relative value from the teaching point 106 serving as the reference to the offset teaching point 107. The virtual display of the robot 101 on the virtual environment screen 10 is updated so as to achieve the position and orientation defined by each articulation value in the setting field 208 of the articulation value setting unit 211.
In this example, only the articulation value of the third articulation (articulation 101a) is changed by the articulation value setting unit 211. Consequently, a state is achieved where as to the orientation of the robot 101 on the virtual environment screen 10, only the angle of the articulation 101a is changed, and the position and orientation on the offset teaching point 107 are also changed. On the parameter setting screen 20, the absolute value setting unit 201 and the relative value setting unit 202 are changed to indicate values according to the change in the articulation values.
As described above, according to this embodiment, the position and orientation data on the robot 101 and the articulations can be input and edited through the representation of the articulation values. Also in the case where the articulation value is operated, the user (operator) can immediately confirm the position and orientation and the parameter of the relative value concurrently with the editing operation. Consequently, the man-hour required for the confirmation can be reduced.
It is a matter of course that the absolute value setting unit 201, the relative value setting unit 202, and the articulation value setting unit 211 on the parameter setting screen 20 can support mutual transformation through the position and orientation calculation by the CPU 33. The example of input into the articulation value setting unit 211 has been described above. Alternatively, it is a matter of course that when any of the absolute value setting unit 201, the relative value setting unit 202, and the articulation value setting unit 211 is edited, the other two can be updated to have corresponding values through the position and orientation calculation. For example, when the absolute value setting unit 201 is edited, the each articulation value can be displayed on the articulation value setting unit 211 according to the orientation calculation result. Also in the case of editing through the relative value setting unit 202 and the case of editing through the operation handle 111, each articulation value can be displayed on the articulation value setting unit 211 according to the orientation calculation result.
Embodiment(s) of the present invention can also be realized by a computer of a system or apparatus that reads out and executes computer executable instructions (e.g., one or more programs) recorded on a storage medium (which may also be referred to more fully as a ‘non-transitory computer-readable storage medium’) to perform the functions of one or more of the above-described embodiment(s) and/or that includes one or more circuits (e.g., application specific integrated circuit (ASIC)) for performing the functions of one or more of the above-described embodiment(s), and by a method performed by the computer of the system or apparatus by, for example, reading out and executing the computer executable instructions from the storage medium to perform the functions of one or more of the above-described embodiment(s) and/or controlling the one or more circuits to perform the functions of one or more of the above-described embodiment(s). The computer may comprise one or more processors (e.g., central processing unit (CPU), micro processing unit (MPU)) and may include a network of separate computers or separate processors to read out and execute the computer executable instructions. The computer executable instructions may be provided to the computer, for example, from a network or the storage medium. The storage medium may include, for example, one or more of a hard disk, a random-access memory (RAM), a read only memory (ROM), a storage of distributed computing systems, an optical disk (such as a compact disc (CD), digital versatile disc (DVD), or Blu-ray Disc (BD)™), a flash memory device, a memory card, and the like.
While the present invention has been described with reference to exemplary embodiments, it is to be understood that the invention is not limited to the disclosed exemplary embodiments. The scope of the following claims is to be accorded the broadest interpretation so as to encompass all such modifications and equivalent structures and functions.
This application claims the benefit of Japanese Patent Application No. 2015-097214, filed May 12, 2015, which is hereby incorporated by reference herein in its entirety.
Number | Date | Country | Kind |
---|---|---|---|
2015-097214 | May 2015 | JP | national |
Number | Date | Country | |
---|---|---|---|
Parent | 15134730 | Apr 2016 | US |
Child | 15983826 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 15983826 | May 2018 | US |
Child | 17373435 | US |