가변 토폴로지 트러스 로봇의 안정적인 주행 알고리즘 개발

학위논문 (박사) -- 서울대학교 대학원 : 공과대학 기계공학과, 2020. 8. 김종원.Variable Topology Truss (VTT) is truss structured modular robot that can self-reconfigure its topology and geometric configuration, which can be usefully applied to rescuing work in disaster site. In this thesis, design of VTT is introduced and stable rolling locomotion algorithm for VTT is proposed. To achieve self-reconfiguration feature, VTT are composed specially designed members and nodes. VTTs members consist of Spiral Zippers which are novel linear actuators that has high extension ratio, light weight and high strength. VTTs nodes consist of Passive Member-Ends and Master Member-Ends. Passive Member-Ends are linkage type spherical joint with large angle range that can accommodate many members. Master Member-Ends are spherical manipulators that built in Sphere and it move member to change topology of VTT. Rolling locomotion of VTT is achieved by controlling the center of mass by geometric reconfiguration. However, the locomotion planning is complex problem, because VTT is parallel mechanism with high degree of freedom and many constraints, which makes it difficult to predict and avoid constraints for feasible planning. Thus, it needs stable algorithm that can find locomotion trajectory even in complicated and large environment. In addition, since VTT has many sophisticated components, the algorithm must prevent VTT being damaged from ground by tumbling. To meet the requirements, proposed locomotion algorithm is composed of 3 steps; support polygon planning, center of mass planning and node position planning. In support polygon planning, support polygon path is planned by newly proposed random search algorithm, Polygon-Based Random Tree (PRT). In center of mass planning, trajectory of desired projected center of mass is planned by maximizing stability feature. Planned support polygon path and center of mass trajectory guide VTT to have good-conditioned shape which configuration is far from constraints and makes locomotion planning success even in complex and large environment. In node position planning, Non-Impact Rolling locomotion algorithm was developed to plan position of VTTs nodes that prevent damage from the ground while following planned support polygon path and center of mass trajectory. The algorithm was verified by two case study. In case study 1, locomotion planning and simulation was performed considering actual constraints of VTT. To avoid collision between VTT and obstacle, safety space was defined and considered in support polygon planning. The result shows that VTT successfully reaches the goal while avoiding obstacles and satisfying constraints. In case study 2, locomotion planning and simulation was performed in the environment having wide space and narrow passage. Nominal length of VTT was set to be large in wide space to move efficiently, and set to be small in narrow passage to pass through it. The result shows that VTT successfully reaches the goal while changing its nominal length in different terrain.가변 토폴로지 트러스 (Variable Topology Truss, VTT)는 토폴로지와 기하학적 형상의 재구성이 가능한 트러스 구조의 모듈 로봇이다. 본 논문에서는 VTT의 설계 구조를 소개하고 VTT의 안정적인 주행을 알고리즘을 제안한다. VTT는 토폴로지와 기하학적 형상의 재구성을 위해 특수한 구조의 멤버와 노드를 가진다. VTT의 멤버는 높은 압축비, 가벼운 중량, 높은 강도를 가진 신개념 선형 구동기인 스파이럴 지퍼로 구성되어 있다. VTT의 노드는 패시브 멤버 엔드와 마스터 엔드로 구성되어 있다. 패시브 멤버는 링키지 구조의 3 자유도 관절로, 넓은 각도 구동 범위를 가지고 있고 많은 수의 멤버를 연결할 수 있다. 마스터 멤버 엔드는 노드 부의 내장된 구형 매니퓰레이터로, 토폴로지 재구성 시 멤버를 이동시키는데 사용된다. VTT는 기하학적 형상을 변화하여 구르는 움직임을 통해 주행한다. VTT의 주행 알고리즘은 서포트 폴리곤 계획 단계, 무게 중심 계획 단계, 노드 위치 계획 단계로 이루어진다. 서포트 폴리곤 계획 단계에서는 새롭게 제안된 무작위 탐색 (random search) 알고리즘인 Polygon-Based Random Tree (PRT)을 적용해 서포트 폴리곤의 경로를 계획한다. 무게 중심 계획 단계에서는 안정성을 최대화하는 VTT의 무게 중심 궤적을 계획한다. 계획된 서포트 폴리곤 경로와 무게 중심 궤적을 VTT가 제한 조건으로부터 먼 좋은 상태의 형상을 유지하게 하여 복잡한 환경에 대해서도 경로 계획이 실패하지 않고 안정적으로 이루어질 수 있도록 한다. 노드 위치 계획 단계에서는 서포트 폴리곤 경로와 노드 위치의 궤적을 추종하는 노드 위치 궤적을 계획한다. 이 과정에서 비충격 롤링 이동 알고리즘 (Non-Impact Rolling locomotion algorithm)을 적용하여 지면과의 충돌로 인한 충격이 일어나지 않는 궤적을 계획한다. 실제 VTT의 제한 조건을 반영한 모델에 본 알고리즘을 적용하여 시뮬레이션을 수행한 결과, VTT가 모든 제한 조건을 만족하고 장애물을 회피하면서 목표 지점에 도달할 수 있음을 확인하였다.Chapter 1. Introduction 1 1.1 Motivation 1 1.2 Previous Truss Type Modular Robot 4 1.3 Previous Research on VTTs Locomotion 8 1.3.1 Heuristic Based Methods 9 1.3.2 Optimization Based Method 10 1.4 Objectives of Locomotion Algorithm 12 1.5 Contribution of Thesis 13 1.5.1 Introduction to Hardware Design of VTT 13 1.5.2 Stable Rolling Locomotion of VTT 15 Chapter 2. Design of Variable Topology Truss 17 2.1 Member Design 18 2.1.1 Spiral Zipper 20 2.1.2 Tensioner 26 2.2 Node Design 28 2.2.1 Passive Member-End and Sphere 29 2.2.2 Master Member-End 36 2.3 Control System 40 2.4 Node Position Control Experiment 44 Chapter 3. Mathematical Model of Variable Topology Truss 47 3.1 Configuration and Terminology 47 3.2 Inverse Kinematics 50 3.3 Constraints 51 3.4 Stability Criteria 64 Chapter 4. Locomotion Algorithm 66 4.1 Concept of Locomotion Algorithm 67 4.1.1 Method for Successful Planning and Obstacle Avoidance 67 4.1.2 Method to Prevent Damage from the Ground 71 4.1.3 Step of Locomotion Algorithm 72 4.2 Support Polygon Planning 73 4.2.1 Polygon-Based Random Tree (PRT) Algorithm 73 4.2.2 Probabilistic Completeness of PRT Algorithm 79 4.3 Center of Mass Planning 85 4.4 Node Position Planning 86 4.4.1 Concept of Non-Impact Rolling Locomotion 86 4.4.2 Planning Algorithm for Non-Impact Rolling Locomotion 89 4.4.3 Optimization Problem of Moving Phase 94 4.4.4 Optimization Problem of Landing Phase 98 4.4.5 Optimization Problem of Transient Phase 99 Chapter 5. Experimental Verification 100 5.1 Case Study 1: Actual VTT Prototype 101 5.1.1 Simulation Condition 101 5.1.2 Obstacle Avoidance Method 103 5.1.3 Simulation Result 104 5.2 Case Study 2: Environment with Narrow Passage 111 5.2.1 Simulation Condition 111 5.2.2 Support Polygon Planning with Varying Nominal Length 114 5.2.3 Simulation Result 117 Chapter 6. Conclusion 126 Bibliography 129 Abstract in Korean 134Docto

New geometric approaches to the analysis and design of Stewart-Gough platforms

In general, rearranging the legs of a Stewart-Gough platform, i.e., changing the locations of its leg attachments, modifies the platform singularity locus in a rather unexpected way. Nevertheless, some leg rearrangements have been recently found to leave singularities invariant. Identification of such rearrangements is useful not only for the kinematic analysis of the platforms, but also as a tool to redesign manipulators avoiding the implementation of multiple spherical joints, which are difficult to construct and have a small motion range. In this study, a summary of these singularity-invariant leg rearrangements is presented, and their practical implications are illustrated with several examples including well-known architectures.The authors gratefully acknowledge funding from the Generalitat de Catalunya through the Robotics group (SRG0155).Peer Reviewe

A study of a novel modular variable geometry frame arranged as a robotic surface

The novel concept of a variable geometry frame is introduced and explored through a three-dimensional robotic surface which is devised and implemented using triangular modules. The link design is optimized using surplus motor dimensions as firm constraints, and round numbers for further arbitrary constraints. Each module is connected by a passive six-bar mechanism that mimics the constraints of a spherical joint at each triangle intersection. A three dimensional inkjet printer is used to create a six-module prototype designed around surplus stepper motors powered by an old computer power supply as a proof-of-concept example. The finite element method is applied to the static and dynamic loading of this device using linear three dimensional (6 degrees of freedom per node) beam elements to calculate the cartesian displacement and force and the angular displacement and torque at each joint. In this way, the traditional methods of finding joint forces and torques are completely bypassed. An efficient algorithm is developed to linearly combine local stiffness matrices into a full structural stiffness matrix for the easy application of loads. This is then decomposed back into the local matrices to easily obtain joint variables used in the design and open-loop control of the surface. Arbitrary equation driven surfaces are approximated ensuring that they are within the joints limits. Moving shapes are then calculated by considering the initial position of the surface, the desired position of the surface, and intermediate shapes at discrete times along the desired path. There are no sensors on the prototype, but feedback models and state estimators are developed for future use. These models include shape sampling methods derived from existing meshing algorithms, trajectory planning using sinusoidal acceleration profiles, spline-based path approximation to allow lower curvature paths able to be traversed more quickly and/or able to be travelled with a constant velocity and optimized by iteratively calculating actuator saturation with no discontinuities, and the optimal tracking of a desired path (modeled with a time-varying ricatti equation)

Kinematic modeling of a double octahedral Variable Geometry Truss (VGT) as an extensible gimbal

This paper presents the complete forward and inverse kinematics solutions for control of the three degree-of-freedom (DOF) double octahedral variable geometry truss (VGT) module as an extensible gimbal. A VGT is a truss structure partially comprised of linearly actuated members. A VGT can be used as joints in a large, lightweight, high load-bearing manipulator for earth- and space-based remote operations, plus industrial applications. The results have been used to control the NASA VGT hardware as an extensible gimbal, demonstrating the capability of this device to be a joint in a VGT-based manipulator. This work is an integral part of a VGT-based manipulator design, simulation, and control tool

Towards a Free-form Transformable Structure: A critical review for the attempts of developing reconfigurable structures that can deliver variable free-form geometries

In continuation of our previous research (Hussein, et al., 2017), this paper examines the kinetic transformable spatial-bar structures that can alter their forms from any free-form geometry to another, which can be named as Free-form transformable structures (FFTS). Since 1994, some precedents have been proposed FFTS for many applications such as controlling solar gain, providing interactive kinetic forms, and control the users' movement within architectural/urban spaces. This research includes a comparative analysis and a critical review of eight FFTS precedents, which revealed some design and technical considerations, issues, and design and evaluation challenges due to the FFTS ability to deliver infinite unpredictable form variations. Additionally, this research presents our novel algorithmic framework to design and evaluate the infinite form variations of FFTS and an actuated prototype that achieved the required movement. The findings of this study revealed some significant design and technical challenges and limitations that require further research work

Robot Assisted Shoulder Rehabilitation: Biomechanical Modelling, Design and Performance Evaluation

The upper limb rehabilitation robots have made it possible to improve the motor recovery in stroke survivors while reducing the burden on physical therapists. Compared to manual arm training, robot-supported training can be more intensive, of longer duration, repetitive and task-oriented. To be aligned with the most biomechanically complex joint of human body, the shoulder, specific considerations have to be made in the design of robotic shoulder exoskeletons. It is important to assist all shoulder degrees-of-freedom (DOFs) when implementing robotic exoskeletons for rehabilitation purposes to increase the range of motion (ROM) and avoid any joint axes misalignments between the robot and human’s shoulder that cause undesirable interaction forces and discomfort to the user. The main objective of this work is to design a safe and a robotic exoskeleton for shoulder rehabilitation with physiologically correct movements, lightweight modules, self-alignment characteristics and large workspace. To achieve this goal a comprehensive review of the existing shoulder rehabilitation exoskeletons is conducted first to outline their main advantages and disadvantages, drawbacks and limitations. The research has then focused on biomechanics of the human shoulder which is studied in detail using robotic analysis techniques, i.e. the human shoulder is modelled as a mechanism. The coupled constrained structure of the robotic exoskeleton connected to a human shoulder is considered as a hybrid human-robot mechanism to solve the problem of joint axes misalignments. Finally, a real-scale prototype of the robotic shoulder rehabilitation exoskeleton was built to test its operation and its ability for shoulder rehabilitation

Multi-agent Collision Avoidance Using Interval Analysis and Symbolic Modelling with its Application to the Novel Polycopter

Coordination is fundamental component of autonomy when a system is defined by multiple mobile agents. For unmanned aerial systems (UAS), challenges originate from their low-level systems, such as their flight dynamics, which are often complex. The thesis begins by examining these low-level dynamics in an analysis of several well known UAS using a novel symbolic component-based framework. It is shown how this approach is used effectively to define key model and performance properties necessary of UAS trajectory control. This is demonstrated initially under the context of linear quadratic regulation (LQR) and model predictive control (MPC) of a quadcopter. The symbolic framework is later extended in the proposal of a novel UAS platform, referred to as the ``Polycopter" for its morphing nature. This dual-tilt axis system has unique authority over is thrust vector, in addition to an ability to actively augment its stability and aerodynamic characteristics. This presents several opportunities in exploitative control design. With an approach to low-level UAS modelling and control proposed, the focus of the thesis shifts to investigate the challenges associated with local trajectory generation for the purpose of multi-agent collision avoidance. This begins with a novel survey of the state-of-the-art geometric approaches with respect to performance, scalability and tolerance to uncertainty. From this survey, the interval avoidance (IA) method is proposed, to incorporate trajectory uncertainty in the geometric derivation of escape trajectories. The method is shown to be more effective in ensuring safe separation in several of the presented conditions, however performance is shown to deteriorate in denser conflicts. Finally, it is shown how by re-framing the IA problem, three dimensional (3D) collision avoidance is achieved. The novel 3D IA method is shown to out perform the original method in three conflict cases by maintaining separation under the effects of uncertainty and in scenarios with multiple obstacles. The performance, scalability and uncertainty tolerance of each presented method is then examined in a set of scenarios resembling typical coordinated UAS operations in an exhaustive Monte-Carlo analysis

Modular Self-Reconfigurable Robotic Systems: A Survey on Hardware Architectures

Modular self-reconfigurable robots present wide and unique solutions for growing demands in the domains of space exploration, automation, consumer products, and so forth. The higher utilization factor and self-healing capabilities are most demanded traits in robotics for real world applications and modular robotics offer better solutions in these perspectives in relation to traditional robotics. The researchers in robotics domain identified various applications and prototyped numerous robotic models while addressing constraints such as homogeneity, reconfigurability, form factor, and power consumption. The diversified nature of various modular robotic solutions proposed for real world applications and utilization of different sensor and actuator interfacing techniques along with physical model optimizations presents implicit challenges to researchers while identifying and visualizing the merits/demerits of various approaches to a solution. This paper attempts to simplify the comparison of various hardware prototypes by providing a brief study on hardware architectures of modular robots capable of self-healing and reconfiguration along with design techniques adopted in modeling robots, interfacing technologies, and so forth over the past 25 years

Cable-driven parallel mechanisms for minimally invasive robotic surgery

Minimally invasive surgery (MIS) has revolutionised surgery by providing faster recovery times, less post-operative complications, improved cosmesis and reduced pain for the patient. Surgical robotics are used to further decrease the invasiveness of procedures, by using yet smaller and fewer incisions or using natural orifices as entry point. However, many robotic systems still suffer from technical challenges such as sufficient instrument dexterity and payloads, leading to limited adoption in clinical practice. Cable-driven parallel mechanisms (CDPMs) have unique properties, which can be used to overcome existing challenges in surgical robotics. These beneficial properties include high end-effector payloads, efficient force transmission and a large configurable instrument workspace. However, the use of CDPMs in MIS is largely unexplored. This research presents the first structured exploration of CDPMs for MIS and demonstrates the potential of this type of mechanism through the development of multiple prototypes: the ESD CYCLOPS, CDAQS, SIMPLE, neuroCYCLOPS and microCYCLOPS. One key challenge for MIS is the access method used to introduce CDPMs into the body. Three different access methods are presented by the prototypes. By focusing on the minimally invasive access method in which CDPMs are introduced into the body, the thesis provides a framework, which can be used by researchers, engineers and clinicians to identify future opportunities of CDPMs in MIS. Additionally, through user studies and pre-clinical studies, these prototypes demonstrate that this type of mechanism has several key advantages for surgical applications in which haptic feedback, safe automation or a high payload are required. These advantages, combined with the different access methods, demonstrate that CDPMs can have a key role in the advancement of MIS technology.Open Acces

DEVELOPMENT OF A KINETIC MODEL FOR STEERABLE CATHETERS FOR MINIMALLY INVASIVE SURGERY

The steerable catheters have demonstrated many advantages to overcome the limitations of the conventional catheters in the minimally invasive surgery. The motion and force transmission from the proximal end to distal tip of the catheter have significant effects to the efficiency and safety of surgery. While the force information between the catheter and the body (e.g., vessel) can be obtained by mounting sensors on the distal tip of the catheter, this would be more intrusive and less reliable than the one without the sensors, which is described in this disseration. In addition, the small diameters of the catheters may also restrict the idea of mounting sensors on the distal tip. The other approach to obtain the force information is to infer it from the information outside the body. This will demand an accurate mathematical model that describes the force and motion relation called kinetic model, and unfortunately, such a kinetic model is not available in the literature. In this dissertation, a kinetic model for steerable catheters is presented wich captures the following characteristics of the steerable catheter, namely (1) the geometrical non-linear behavior of the catheter in motion, (2) the deformable pathway, (3) the friction between the catheter and the pathyway, and (4) the contact between the catheter and pathway. A non-linear finite element system (SPACAR) was employed to capture these characteristics. A test-bed was built and an experiment was carried out to verify the developed kinetic model. The following conclusions can be drawn from this dissertation: (1) the developed kinetic model is accurte in comparison with those in literature; (2) the Dahl friction model, the LuGre friction model and the simplified LuGre friction model are able to capture the friction behavior between the catheter and the pathway but the Coulomb friction model fails (as it cannot capture the hysteresis property which has a significant influence on the behavior of the catheter); (3) the developed kinetic model has the potential of being used to optimize the design and operation of steerable catheters with several salient findings that (3a) the maximal contact force between the catheter and the pathway occurs on the tip of the distal part or the connecting part between the distal part and catheter body of the catheter and (3b) the rigidity and length of the distal part are crucial structural parameters that affect the motion and force transmission significantly. There are several contributions made by this dissertation. In the field of the steerable catheter, biomechanics and bio-instrumentation, the contributions are summarized in the following: (1) the approach to develop the kinetic model of the steerable catheter in a complex work environment is useful to model other similar compliant medical devices, such as endoscope; (2) the kinetic model of the steerable catheter can provide the force information to improve the efficiency and safety of MIS (minimally invastive surgery) and to realize the “doctor-assisted” catheter-based MIS procedure; (3) the kinetic model can provide accurate data for developing other simplified models for the steerable catheters in their corresponding work environments for realizing the robotic-based fully automated MIS procedure. (4) The kinetic model of the steerable catheter and the test-bed with the corresponding instruments and methods for the kinetic and kinematic measurements are a useful design validation in the steerable catheter technology as well as for the training of physicians to perform the catheter-based interventional procedure by adding more complex anatomic phantoms. In the field of continuum manipulator and continuum robots, the approach to develop the kinetic model is useful to model other manipulators and robots, such as snake-like robots