10 results about "Joint coordinate system" patented technology

The invention discloses an automatic mounting method and system for a cambered surface wood board based on dynamic point cloud analysis, and the method comprises the steps: building a joint coordinate system of a mechanical arm and point cloud collection equipment, and obtaining a calibration matrix through a specific motion track of the mechanical arm; carrying out initial scanning on the cambered surface substrate on which the wood board is not mounted, and carrying out single-side arc fitting by utilizing a single-side point cloud fitting algorithm to obtain an initial circle center coordinate and a radius; entering a dynamic installation cycle, collecting local point cloud data of the current installation area, and executing Z value mutation feature detection to identify the edge position of the installed part; calculating an actual installation deviation based on the edge position, and dynamically compensating a pose parameter of the wood board to be installed according to the deviation; and according to the cambered surface radius updated in real time, the installation number of the remaining wood boards is adjusted in a self-adaptive mode, and control instructions of the to-be-installed wood boards are generated in batches and sent to the mechanical arm to be installed till all laying is completed. According to the invention, the installation precision and the engineering efficiency of cambered surface packaging are obviously improved.

The invention provides a robot FKM kinematics modeling method, and aims to solve the problems of rotation and translation coupling, non-intuitive parameter significance, complex modeling and the like in the existing robot kinematics modeling process. The method comprises the following steps: establishing a joint coordinate system of the robot, and determining a transformation parameter of each joint and a homogeneous transformation matrix of an adjacent coordinate system; wherein the expression of the homogeneous transformation matrix has two forms according to different joint types, and the expression of a rotating joint is as shown in the specification, and the expression of a moving joint is as shown in the specification. A translation transformation matrix of the coordinate system relative to the coordinate system is in the formula; the rotation transformation matrix is a rotation transformation matrix rotating around the translated X axis; the forward kinematics model of the robot can be obtained by sequentially multiplying the homogeneous transformation matrixes of all the joints for the rotating joints as a rotation transformation matrix rotating around the rotated Z axis and for the moving joints as a translation matrix moving along the rotated Z axis. According to the method, basic transformation and joint variables of the coordinate system are decoupled, so that the modeling process is more visual, the parameter significance is clearer, and the method can be widely applied to the field of kinematics modeling and control of industrial robots and service robots.

The application relates to the technical field of semiconductor manufacturing, and discloses a control method, system and device of a vacuum manipulator and a storage medium. The control method of the vacuum manipulator comprises the following steps: establishing a kinematics model between a motor coordinate system and a joint coordinate system of each manipulator; after receiving a motion instruction, planning an initial motion path from a starting point to an initial target point for each manipulator indicated by the motion instruction; generating a control instruction of a motor corresponding to each manipulator based on the kinematics model and the initial motion path planned for each manipulator, so that each manipulator is driven to perform asynchronous motion; in the process that each manipulator moves to the initial target point according to the initial motion path, a dynamic correction operation is executed in real time, the manipulator is controlled to move from a current position on the initial motion path to a correction target position along a correction motion path, and the placement of a wafer is completed. The technical scheme of the application improves the transmission efficiency of the manipulator and also improves the transmission accuracy of the manipulator.

The invention relates to the technical field of semiconductor manufacturing, and discloses a control method, system and equipment of a vacuum manipulator and a storage medium. The control method of the vacuum manipulator comprises the following steps: establishing a kinematic model between a motor coordinate system and a joint coordinate system of each manipulator; after a motion instruction is received, planning an initial motion path from a starting point to an initial target point for each manipulator indicated by the motion instruction; based on the kinematic model and the initial motion paths planned for the manipulators, control instructions of motors corresponding to the manipulators are generated so as to drive the manipulators to do asynchronous motion; and in the process that the manipulators move to the initial target point according to the initial motion path, dynamic deviation correction operation is executed in real time, and the manipulators are controlled to move to the deviation correction target position from the current position of the initial motion path along the deviation correction motion path so as to complete wafer placement. According to the technical scheme, the transmission efficiency of the mechanical arm is improved, and meanwhile the transmission precision of the mechanical arm is improved.

A robotic surgical system and method including a navigation catheter including a sensor and for endoluminal navigation, a robotic arm having a laparoscopic surgical instrument and a second sensor, and a computing system including a processor and a memory, the memory storing instructions that when executed by the processor cause the processor to detect a position and orientation of the catheter as it is navigated into a luminal network towards a target, register the luminal network to a three-dimensional (3D) model of the luminal network and a pathway plan, display on a user interface a representation of a distal portion of the catheter, determine that the catheter is in proximity to the target, detect a position and orientation of the second sensor; and display on the user interface a representation of the laparoscopic surgical instrument's position and orientation relative to the position and orientation of the catheter.

This invention discloses a method, system, device, and medium for avoiding singularities in a robotic arm under different operational requirements. The method includes: determining the transformation matrix between the joint coordinate system and the Cartesian coordinate system based on the kinematic model of the robotic arm; marking all operational areas on the Cartesian motion trajectory of the robotic arm; identifying all singularities from all operational areas based on several motion information associated with several interpolation points in each operational area and the transformation matrix; and assigning corresponding singularity avoidance strategies to all singularities based on a singularity avoidance evaluation parameter library associated with all operational areas. This invention can accelerate the singularity detection speed by automatically adjusting the detection step size, and corrects the trajectory of all singularities within different operational areas by assigning singularity avoidance strategies to different operational areas containing singularities, thereby reducing the damage caused by the singularity of the robotic arm while better completing the task.

The invention discloses a robot inverse kinematics experiment teaching method and device, a storage medium and a program product. The method comprises the following steps that 1, the structure and parameters of a robot are analyzed; 2, drawing a robot model sketch according to the structure and parameters of the robot; step 3, setting a robot joint coordinate system according to the robot model sketch; 4, according to the robot joint coordinate system, robot DH parameters are solved; carrying out DH parameter judgment, and if the DH parameter is correct, carrying out the next step; otherwise, repeating the steps 1 to 4; 5, robot modeling is carried out according to the solved DH parameters; step 6, setting a motion path of an end effector of the robot; 7, discretely generating a motion track in the Matlab; 8, according to an inverse kinematics equation, solving joint parameters corresponding to the discretized motion trail; 9, robot joint parameters are output; robot joint parameters are judged, and if the joint parameters are correct, the next step is carried out; otherwise, repeating the steps 8 to 9; 10, a robot controller is read, and joint parameters are input; step 11, controlling the robot to run on line, judging a running track, and if the running track is the same as a set track, completing the experiment; otherwise, repeating the steps 7 to 11. According to the method, the inverse kinematics solution and verification experiment of robotics can be conveniently carried out.

This invention discloses a pose control method for a joint-biased seven-degree-of-freedom (DOF) robotic arm, comprising: establishing joint coordinate systems for the seven joints of the seven-DOF robotic arm; listing a parameter table based on the transformation relationships between the joint coordinate systems of the seven joints; calculating the forward kinematic transformation matrix of the seven-DOF robotic arm through the transformation relationships between any two coordinate systems of the seven joints; determining the parameters for calculating the coordinates of each reference point for the arm profile angle, and defining the arm profile surface and reference plane according to the target end-effector pose; constructing an extended Jacobian matrix based on the calculation relationship of the arm profile angle, and using a numerical method to solve for each joint angle under a given end-effector pose. The pose control method for a joint-biased seven-DOF robotic arm of this invention has advantages such as constraining the infinite number of solutions of the seven-DOF robotic arm to a finite number of solutions, solving the uncertainty of the kinematic solutions of the biased seven-DOF robotic arm, improving computational accuracy and numerical stability, and enhancing control determinism.

The invention relates to a generalized complex mechanism kinematics resolving method, which comprises the following steps of: 1, establishing a proper coordinate system according to a physical structure of a mechanism, including a whole device reference coordinate system O0, a reference plane coordinate system where a mechanism base is located, four joint coordinate systems O2 to O5, and a tail end coordinate system O6; step 2, mapping the relation between the coordinate systems into a unit model; 3, acquiring external input of each layer of unit model, and assembling the unit models to form a kinematics resolving process; 4, kinematics calculation is conducted, and the tail end position and posture of the mechanism are obtained and serve as output. On the basis of the physical structure of the mechanism, a unitized structure model is formed, and all units are mutually assembled to finally form a complete mechanism kinematics resolving process.

The application discloses a long-term identity recognition method and system for multiple cat individuals. The face three-dimensional point cloud data, cat eye iris data and palm print data of the cat are collected and converted to the same three-dimensional joint coordinate system for alignment of the physical space. Then, three parallel feature extraction networks are used to extract features from the aligned data, and after splicing and dimension reduction, preliminary fusion features are obtained. The preliminary fusion features are subjected to attention enhancement and residual connection to obtain a fusion feature vector. The fusion feature vectors of an individual at different periods are saved in a historical feature sequence in chronological order to construct a multi-individual feature library. The most similar individual to the individual to be identified is found in the feature library as a candidate cat through cosine similarity comparison. The time sequence evolution features of the candidate cat are predicted, the similarity between the time sequence evolution features, the historical features and the individual to be identified is judged to determine the identity of the individual to be identified, and the feature library is updated.