The invention relates to the technical field of ultrasonic medical robots, and discloses a superficial ultrasonic scanning path
planning method and device based on an SVD-improved RRT
algorithm. The superficial ultrasonic scanning path
planning method is applied to ultrasonic
medical robot equipment, and specifically comprises the following steps: S101, receiving a
data acquisition request sent by a main control end, controlling a Kinect camera to acquire a superficial depth image,
processing 20 groups of calibration board images through a
Matlab calibration tool box, and executing a
corner detection algorithm to identify
checkerboard corners, and optimizing and solving the internal reference matrix of the
infrared camera. According to the method, SVD
plane fitting and an improved RRT
algorithm are fused, the precision and efficiency of an ultrasonic scanning path are remarkably improved, in the
point cloud processing stage,
statistical filtering and
voxel gravity center down-sampling synergistically act,
point cloud noise is reduced by 90%, meanwhile, more than 95% of three-dimensional features are reserved, a high-fidelity data basis is provided for path planning, and the method has good application prospects. SVD
plane fitting forcibly passes through the
center of mass, and the error is smaller than or equal to 0.5 mm