Design of a Humanoid Biped for Walking Research by Daniel Joseph Paluska Submitted to the Department of Mechanical Engineering in partial fulfillment of the requirements for the degree of MASSACHUSETTS INSTITUTE OF TECHNOLOGY Master of Science at the OCT 0 2 2003 LIBRARIES MASSACHUSETTS INSTITUTE OF TECHNOLOGY September 2000 @ Massachusetts MASSACHUSETTS INSTITUTE OF TECHNOLOGY Institute of Technology 2000 LIBRARIES Signature of Author Department of Mechanical Engineering August 31, 2000 Gill A. Pratt Assistant Professor of Electrical Engineering and Computer Science, MIT Thesis Supervisor C ertified by ................................ . Certified by........ Ernesto Blan6'0-Adjunct Professor of Mechanical Engineering, MIT Thesis Supervisor A ccepted by ...................................... Ain onin Chairman, Departmental Committee on Graduate Students Design of a Humanoid Biped for Walking Research by Daniel Joseph Paluska Submitted to the Department of Mechanical Engineering on August 31, 2000, in partial fulfillment of the requirements for the degree of Master of Science Abstract This thesis presents the design of the robot M2. The primary motivation behind the work is to create a platform for research into bipedal walking. Bipedal robots have been built in the past, but most of them relied heavily on lessons from robotic arm research. There is evidence that suggests actuation and design for legged locomotion should deviate from the past standard of robotic arm design. Specifically, there should be an emphasis on low impedance actuation, shock tolerance, passive control mechanisms, and weight reduction. Human data which supports these points is presented. The robot M2 was designed with these things in mind. M2 is a humanoid bipedal robot with twelve active degrees of freedom. It is essentially a torso and two legs and with linear dimensions of a 50th percentile US male. It weighs approximately 60 lbs(25kg). All the active degrees of freedom are powered using Series Elastic Actuators, which provide force control and shock tolerance. For simplicity, degrees of freedom above the hip are absent. Thesis Supervisor: Gill A. Pratt Title: Assistant Professor of Electrical Engineering and Computer Science, MIT Thesis Supervisor: Ernesto Blanco Title:Adjunct Professor of Mechanical Engineering, MIT 3 Acknowledgments The development of the robot has been a three person project from the beginning. Jerry Pratt and David Robinson worked on the robot with me. Jerry performed preliminary simulations to determine feasibility of mass distributions and power requirements. David Robinson is responsible for the actuator design. I also had lots of help from Ben Krupp and Chris Morse who each had there own robot to build in the process. Pete Dilworth contributed plenty of tips from his own bipedal robot building experience. Allen Parseghian has been working hard with me trying to get the robot to actually walk. John Hurst has helped with debugging some actuator problems and designing a battery rig. Thanks to Mike Wessler and Andreas Hofmann for creation of and help with software tools. Thanks to Chris Barnhart for developing the DSP platform and handling my ignorance of all things DSP. During the construction, I had help from many people. We had several soldering parties in the lab which involved people sitting around the main lab table soldering. Jerry, Ben, Chris, Mike, Gaddy, Pete, and others participated in these. In addition, Jess helped me with cable making and was an immense help with my supposed native language. Professor Pratt has been a wonderful advisor. I am constantly amazed at how he has always placed his students first. I have loved working in the lab and getting to play around! Special thanks goes to my friends and family who have made the time outside the lab great! You've kept me sane during the worst of thesis despair. This research was supportd by DARPA under contract number N39998-00-C-0656. Contents 1 Introduction 1.1 1.2 2 Human Characteristics 2.1 The Human Form . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11 11 2.2 4 5 9 10 2.1.1 3 9 Goals of Thesis . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Summary of Thesis . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Weight Distribution . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2.1.2 Link Lengths . . . . . . . . . . . . . Human Motion . . . . . . . . . . . . . . . . 2.2.1 Energetics of Human Walking . . . . 2.2.2 Human Kinetic and Kinematic Data Robots and Actuators 3.1 Robotic Arms vs. Robotic 3.2 Passive Dynamic Walkers 3.3 Powered Bipedal Walkers 3.4 Series Elastic Actuators . 11 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11 14 14 15 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 16 16 16 17 17 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 19 19 19 19 22 22 22 24 25 Electronics and Control Systems 5.1 Electronics Overview . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 27 27 W alkers . . . . . . . . . . . . . . . Robot Mechanical Design 4.1 General Robot Architecture 4.2 The Design . . . . . . . . . 4.2.1 Overall Structure . . 4.2.2 Actuators . . . . . . 4.2.3 Ankle . . . . . . . . 4.2.4 Foot . . . . . . . . . 4.2.5 Hip . . . . . . . . . 4.2.6 Knee . . . . . . . . . 5.1.1 5.2 . . . . . . . . . . . . . . . . . . . . . . . . 48 Volt bus . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5.1.2 Robot Sensors . . . . . . . . . . . Custom Circuit Boards . . . . . . . . . . . 5.2.1 The Signal Conditioning Boards . 5.2.2 The Analog Force Control Boards 5.2.3 The Analog Breakout Board . . . 5.2.4 The Power Distribution Boards . . 5.2.5 5.3 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 27 . . . . . . 27 29 29 29 31 31 The DSP and Analog I/O . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 31 Control Software . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4 31 5 CONTENTS A Joint Math A .1 K nee Joint . . . . . . . . . . . . . . . . . . . . . . . ......................................... A.2 Ankle Joint ......... A .3 H ip Joint . . . . . . . . . . . . . . . . . . . . . . . . A .3.1 H ip P itch . . . . . . . . . . . . . . . . . . . . A .3.2 Hip Roll and Yaw . . . . . . . . . . . . . . . 34 . . . . . . . . . . . . . . . . . . 34 36 . . . . . . . . . . . . . . . . . . 37 . . . . . . . . . . . . . . . . . . 37 . . . . . . . . . . . . . . . . . . 37 B Electrical Schematics 39 C Suppliers and Costs C .1 C osts . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 50 53 List of Figures 2-1 The X velocities of the various parts of the body during a normal walking cycle. Adapted from data in Winter(20). . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2-2 The frontal plane dimensions of a 50th percentile U.S. male. Adapted from data in Dreyfus(2). All dimensions are in inches. . . . . . . . . . . . . . . . . . . . . . . . . . 2-3 Several strides of the compass gait shown with corresponding potential and kinetic energy curves. From Krupp(8). . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3-1 3-2 Some previous powered bipedal walking robots. . . . . . . . . . . . . . . . . . . . . . An annotated rendering of the Series Elastic Actuator which is used in the robot M2. Modeled and rendered by David Robinson. . . . . . . . . . . . . . . . . . . . . . . . 12 13 14 17 18 4-1 A photo of the completed robot and a joint schematic view of the robot. The schematic shows active degrees of freedom only. The optional passive toe joint is not shown. . 4-2 The dimensions of the biped in the frontal plane. The body and links are approximately axially symmetric about their longitudinal axis. Dimensions are in inches. 4-3 A schematic of the ankle joint actuation scheme. The axes shown are fixed to the center of the universal joint. The points A,E, and 0 are referenced in Appendix A. 4-4 The dimensions of the biped foot with passive toe joint. The X's represent the location of the load cells. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4-5 A schematic of the biped hip. The pitch actuator is not shown. It lies along the axis of the thigh . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4-6 A photo of the biped thigh illustrating the hip pitch cable drive system. . . . . . . . 4-7 The ranges of motion on the robot ankle joint. The ankle roll is symmetric(+- 20 deg). 4-8 The range of motion of the robot knee. The knee has 80 degrees of motion. . . . . . 20 21 23 23 24 24 25 26 5-1 An overview of the biped electronics. Thick lines indicate power transfer and arrowheads indicate information flow. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5-2 A photo of M2 with annotations of electrical systems. . . . . . . . . . . . . . . . . . 5-3 A photo of the biped strain gauge signal conditioning board. This board handles two strain gauges. There are a total of four of these boards on the robot. . . . . . . . . 5-4 A photo of the analog force control and joint pot buffer board. There are six identical boards on the robot. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . A-1 The robot knee joint with superimposed lines and points. Points 0, A and M all refer to pin joints. 0 is the knee joint. M is where the actuator is mounted to the thigh and A is where the actuator is attached to the shin. . . . . . . . . . . . . . . . . . . A-2 A line drawing of the knee for the calculation of knee actuator desired force. The actuator is the line segment MA. This drawing also pertains to the geometry of the hip and ankle joints but the hip and ankle actuators have motions out of the plane whereas the knee actuator is always in the plane perpendicular to the knee axis. . . 6 28 29 30 30 35 35 LIST OF FIGURES A-3 A simple view of the actuation of the robot ankle. This is a tranverse plane slice of the robot ankle. Point 0 is the intersection of the X and Y axes as well as the center of the ankle universal joint. Points Al and A2 represent the attachment points of the two actuators respectively. Forces in the actuators create torques about both the X and Y axes. Joint rotations change the relative lengths of the X and Y projections(rz and ry) of the moment arms, therefore affecting the torque to force transformation. A-4 The robot hip joint schematic. Point 0 refers to the hip universal joint. The Z(hip yaw) and Y(hip roll) axes intersect at point 0. Point Mr refers to the universal joint on the body where the roll actuator is mounted. Point A, refers to the ball joint on the thigh where the roll actuator is attached. Point MY refers to the pin joint where the yaw actuator is attached to body. Point Ay is the pin joint attachment of the yaw . . . . . . . . . actuator to the yaw universal block. It is hidden in this schematic. Page 1 of 6 of the biped force board. . . . . . . . . . . . . . . . . . . . . . . . . . . . Page 2 of 6 the biped force board. . . . . . . . . . . . . . . . . . . . . . . . . . . . . Page 3 of 6 of the biped force board. . . . . . . . . . . . . . . . . . . . . . . . . . . . Page 4 of 6 the biped force board. . . . . . . . . . . . . . . . . . . . . . . . . . . . . Page 5 of 6 of the biped force board. . . . . . . . . . . . . . . . . . . . . . . . . . . . Page 6 of 6 the biped force board. . . . . . . . . . . . . . . . . . . . . . . . . . . . . Page 1 of 2 of the strain gauge conditioning board. . . . . . . . . . . . . . . . . . . . Page 2 of 2 of the strain gauge conditioning board. . . . . . . . . . . . . . . . . . . . Page 1 of 1 of the analog I/O breakout board. This board is designed to interface with the ANA070 and ANA064 from Digital Designs and Systems. . . . . . . . . . . B-10 Page 1 of 1 of the M2 power distribution board. This board has two different population options. One to power the DSP and one to power the Intersense IS-300 tracker. B-1 B-2 B-3 B-4 B-5 B-6 B-7 B-8 B-9 7 36 37 40 41 42 43 44 45 46 47 48 49 List of Tables 2.1 2.2 4.1 Human Mass Distribution. From Dempster(3). . . . . . . . . . . . . . . . . . . . . . Human walking parameters from normalized data contained in Human Walking(18). Forces and power calculated for a for 1.83 m(6'2"), 80 kg(1781b) person. Table displays non-concurrent maximum values which occur during an average walking cycle. . . . 11 15 Robot Joint Specifications. Torque and rad/s numbers are given for maximum moment arm. Power, torque, and velocity are symmetric due to the actuator. *The ankle roll and pitch are not independent. Their maximum values can not be applied sim ultaneously. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Approximate distribution of mass in humans, the biped M2, and McGeer's kneed passive dynamic walker(PDW). Human data adapted from Dempster and Gaughran (3). Robot weight distribution is driven primarily by actuator locations. Each actuator is approxim ately 1.2kg(2.5 lbs). . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 22 Circuit Boards on the Robot . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Sensors on the Robot . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 27 28 C.1 Basic robot budget. See Robinson et al.((17)) for more detail on the actuator. This budget does not include prototyping or development costs. Part quantities and individual costs are not necessarily meant to imply identical parts but rather to give an average price for all units of a certain type. . . . . . . . . . . . . . . . . . . . . . . . 54 4.2 5.1 5.2 8 19 Chapter 1 Introduction 1.1 Goals of Thesis The goal of this research project was to design a three dimensional, free standing bipedal robot. The main goal of the biped, M2, is to be a testbed for control ideas and walking research. Originally the robot was not specifically 'humanoid,' but after a bit of research we determined it would be the best course of action for several reasons. " There is a vast amount of data regarding human form and motion. " The robot can be considered a human replacement for hazardous situations. " The robot will be large enough to avoid problems of miniaturization. " Ideas regarding human control of locomotion can be tested. This thesis concentrates on documenting the mechanical portion of the project. The design of the robot was guided by several specific goals which include walking 1 m/s, climbing normal stairs, looking biological, turning dynamically, a three year life-span, and ten hours working time between mechanical or electrical failures. The following points dominated the design decisions of the robot. 1. Series Elastic Actuators Series Elastic Actuators(12) are used for all of the active degrees of freedom. These actuators provide force control as well as shock tolerance. Evidence suggests both factors are necessary for the task of biologically similar walking. The low output impedance of the actuators allows us to take advantage of the robot's natural dynamics. All joints employ the same actuator design to minimize complexity and facilitate repairs. 2. Human Proportions The use of human proportions allows for easy comparison with biomechanics data. Human sizing also allows for use of large, standard components which are easy to see and debug. Also, by using human proportions, the research stays focused on walking and not on miniaturization. 3. Lightweight The robot frame is carbon fiber and most other components are plastic or aluminum. The necessary actuator forces are kept low. A less massive robot is more manageable in a research environment. It is easier to handle and less likely to damage itself or harm researchers. 4. Mechanical Control Mechanisms Each joint (most importantly the knee) has adjustable stops with rubber pads. The foot of the robot is equipped with a passive toe joint. This joint has an adjustable range as well as a return spring. The limit stops are essentially high frequency non-linear PD loops which are difficult to implement in digital control even with the use of sophisticated electronics and sensors. The low impedance actuators allow for uncertain 9 CHAPTER 1. INTRODUCTION 10 contact, an inevitable occurence during walking on rough terrain. These mechanical features eliminate the need to operate any digital high frequency control loops on the robot. The robot is a three dimensional continuation of the work that began with the planar robot Spring Turkey(13) and continued with the planar robot Spring Flamingo(15). The previously enumerated points are the key areas where M2 differs from some other current three dimensional humanoid walkers(6, 21) which rely more on high impedance actuation and trajectory following control schemes. 1.2 Summary of Thesis This thesis presents the design of the humanoid robot M2. " Chapter 2 describes the human mechanisms and the forces, torques, velocities, etc. which are exhibited during a normal walking cycle. The human is a good starting point for the design of the robot. Human locomotion is well documented and there is a wealth of information on the human walking motion. " Chapter 3 describes previous robots and actuators. It presents some of the differences between robotic arm and walking robot technology. There is a brief introduction to Series Elastic Actuators. " Chapter 4 describes the mechanical specifics of the robot. " Chapter 5 details the electronic, sensor, computer, and control systems on the robot. * Chapter 6 gives some conclusions and some advice for future research. " Appendix A describes the transformations from joint torques to actuator linear forces. " Appendix B contains all the schematics for the custom circuit boards on the robot. " Appendix C has a list of all of the suppliers that were used. Chapter 2 Human Characteristics There is a large database of knowledge regarding both the human form and human motion. We believe that mechanical characteristics found in humans aid in the control of walking and we should try to consider which of these characteristics can be embodied with current mechanical and robotic technologies. 2.1 The Human Form 2.1.1 Weight Distribution An approximation of the human weight distribution is shown in Table 2.1. From this we can see that nearly 70% of the mass in humans is located at the waist and above. Figure 2-1 shows the linear velocities(in the walking direction, X) of different body areas. It can be seens that the body has the least fluctuation in forward velocity and the foot has the most fluctuation. Since kinetic energy is a direct function of velocity, the lower extremities have the greatest fluctuations in kinetic energy. It is clear that more mass at the feet means more energy change. If this energy is all lost it would be very costly. In efficient walking, the mass is able to resonate with gravitational or elastic potential energy. An example of this can be seen in the compass gait described in the next section. 2.1.2 Link Lengths The dimensions of a 50th percentile male are shown in Figure 2-2. The center of gravity is just above the hip at approximately 38". Table 2.1: Human Mass Distribution. From Dempster(3). Body Area Head, neck, Shoulders, Thorax Arm Ab/Pelvic Thigh Shin and foot Percentage per Part 31% 5% 27% 10% 6% 11 No. of Instances 1 2 1 2 2 Total Mass Percentage 31% 10% 27% 20% 12% 12 CHAPTER 2. HUMAN CHARACTERISTICS - ribcag( / 4 / / 3 ~ ,~. .. - shin t-p knee - I / I - /,. -- ankle -- toe -1 *Ij 1 '-I 4j 2 0 1 0 5 10J 15 20 25 30 3 0 4 50 55 60 65 1 -1 Frame Number Figure 2-1: The X velocities of the various parts of the body during a normal walking cycle. Adapted from data in Winter(20). CHAPTER 2. HUMAN CHARACTERISTICS 13 -69.10 6.10 60.20 56.70 i L 7.00 (Hip Spacing) 14.20 LI -KHI 36.50 19.80 0 I I I I 3.20 3.90 - 0 Figure 2-2: The frontal plane dimensions of a 50th percentile U.S. male. Adapted from data in Dreyfus(2). All dimensions are in inches. CHAPTER 2. HUMAN CHARACTERISTICS 14 KE PE I\ \ / \ / / Figure 2-3: Several strides of the compass gait shown with corresponding potential and kinetic energy curves. From Krupp(8). 2.2 2.2.1 Human Motion Energetics of Human Walking Data in Rose et al.(18) shows us that a 1801b person walking at a normal pace consumes about 320 Watts of power. It is estimated that roughly one quarter of that is mechanical power. This means that at a comfortable pace, a 1801b human can walk with only 80 Watts of mechanical power. This can be a somewhat depressing fact considering one of the electric motors used on the robot M2 can output 90 Watts continuously - and there are 12 motors on the robot! Hopefully research on M2 will allow future robots to walk as mechanically efficient as a human. A simplified human gait known as a compass gait can give us insight into the energetics of walking. The compass gait model consists of two rigid, massless legs attached at the hip with a pin joint. A point mass is modeled at the hip joint. With the only degree of freedom located at the hip, the body is forced to follow an arc defined by the length of the leg. The compass gait can be seen in Figure 2-3. The compass biped has instantaneous, discretely changing dynamics. It simply changes from one inverted pendulum to another when the swing leg touches the ground. Calculating the external work on the model, namely the potential and kinetic energy of the system PE = MgLcosO (2.1) KE MgL(1-cosO) (2.2) = By graphing the equations 2.1 and 2.2 in Figure 2-3, the cyclical nature of potential energy and kinetic energy can be seen. Note that the kinetic energy is maximum when the potential energy is minimum and vice versa. Similar cyclical transition of potential and kinetic energy was recorded CHAPTER 2. HUMAN CHARACTERISTICS hip(pitch) hip(roll) hip(yaw) knee(pitch) ankle(pitch) ankle(roll) 15 deg rad/s Nm W 30,-18 8,-7 5,-15 68,8 10,-15 na 3.6,-2.0 1.6,-1.0 4.0,-3.0 5.8,-7.8 3.0,-4.2 NA -111.0 -63.5 8.0 -71.4 -63.5 40.0 56 +-28 -16 -79.5 280 -16 Table 2.2: Human walking parameters from normalized data contained in Human Walking(18). Forces and power calculated for a for 1.83 m(6'2"), 80 kg(1781b) person. Table displays nonconcurrent maximum values which occur during an average walking cycle. in human subjects by McMahon (11) using force plate data to calculate the changes in mechanical energy of the body's center of mass. The compass gait is similar to the behavior found in the passive dynamic walkers described in the next section. There is also evidence that humans use some passive dynamics during the gait cycle. At the beginning of swing phase, the leg receives a tiny impulse of energy and then the natural pendulum motion carries it forward to extension. The leg receives another tiny impulse of energy to bring it to a sudden halt before touchdown. Electromyographic data record by McMahon (11) shows little electrical activity in the leg muscles of humans during the swing phase at normal walking speeds. This suggests that the leg is swinging freely during this period. In addition, electromyographic records show significant electrical activity in leg muscles during stance. 2.2.2 Human Kinetic and Kinematic Data There is a wealth of data from recordings of human motion. These recordings have been transferred into data regarding joint motions and joint torques during the walking cycle. In addition, the author relied on a rather low-tech method for extracting velocity data from the graphical position data. Power, torque, position, and velocity data for an average human walking cycle are shown in Table 2.2. Chapter 3 Robots and Actuators 3.1 Robotic Arms vs. Robotic Walkers Many high performance robotic arms and hands have been developed for use in factories, space, and research(19). It might seem to an outside observer that these technologies could be exploited for use in a legged robot. Most of the time this is not the case. There are several reasons why. " Fixed vs. Floating Reference Robotic arms are generally fixed to an inertial reference frame(factory) or a body whose mass is large enough that it can be considered fixed(spacecraft). A walking robot is not fixed to any reference frame and has a limited set of torques which it can apply due to its limited contact with the world. " Onboard vs. Offboard Robot arms can often place their heavy motors at their fixed end. Then the motors are only responsible for moving the frame of the arm and not themselves. Because a walking robot must carry all its components, the motors support themselves as well as the structure of the robot. Carrying power is also an issue for walking robots although most are tethered due to battery limitations. * Environmental Awareness Robot arms are not usually expected to perform in unknown situations. They generally are designed for specific working conditions and their ability to handle unexpected disturbances is limited. Ideally, walking robots are supposed to handle rough and unknown terrain. " Success Metrics Robotic arms are often judged on their ability to position their end effectors precisely. Robotic walkers are usually not judged on their ability to position precisely but rather on their ability to get from Point A to Point B without falling down. " Impacts Most robot arms are not designed to handle impacts. Walking, however, has an impact at every touchdown. 3.2 Passive Dynamic Walkers Much research has been done on completely passive walking machines (5, 1, 4). Passive dynamic walkers use Earth's gravity as a power supply. They rely on special geometry and mechanical mechanisms as control systems to achieve gaits very similar to the compass gait depicted in Figure 2-3. Though they are not robots in the traditional sense, they can give insight into walking machines. These 'robots' exploit passive dynamic elements and mechanical mechanisms to achieve highly efficient gaits. In the limit, a passive dynamic walker relies entirely on passive dynamic motions and thus requires no external power source other than a small incline. Several passive legged 'robots' such as these have been constructed and succesfully demonstrated (5, 1, 4, 9). 16 CHAPTER 3. ROBOTS AND ACTUATORS 17 Figure 3-1: Some previous powered bipedal walking robots. From top left to bottom right are WL-10RV1 from Waseda, P2 from Honda, Toddler from UNH, the Moscow State University Biped, SD-2 from Clemson and Ohio State, Biper from University of Tokyo, Meltran II from Mechanical Engineering Lab in Tsukuba, and Timmy from Harvard. Figures compiled by J. Pratt. 3.3 Powered Bipedal Walkers Many bipedal walking robots have been built over the years. Several of these robots are shown in Figure 3-1. These biped walking robots fall into two broad categories: those which predominantly use pre-recorded trajectory playback and those which predominantly use an algorithmic controller. All the robots employ a high impedance actuation scheme and none take advantage of natural dynamics. Passive dynamics were successfully implemented in actuated robots as well. J. Pratt (16) developed algorithms that used the natural dynamics of the swing leg to efficiently control a planar bipedal robot. More recently, J. Pratt has developed three-dimensional simulations of M2 using passive elements such as a knee cap, a compliant ankle, and a passive swing leg to achieve natural looking and efficient walking. 3.4 Series Elastic Actuators Series Elastic Actuators(SEA's)(14) are actuators which have an elastic element in series with the motor and gear train. A sensor measures the displacement of the elastic element and force is implied by Hooke's Law, F = kx. In short, SEA's provide force control, shock tolerance, and low impedance actuation. A more detailed account of their benefits and limits can be found in Robinson et al.(17) A rendering of the SEA used on M2 can be seen in Figure 3-2. The brushless DC motor is modified to have a ballscrew as its rotor. The output of the ballscrew is attached to an aluminum CHAPTER 3. ROBOTS AND ACTUATORS 18 Figure 3-2: An annotated rendering of the Series Elastic Actuator which is used in the robot M2. Modeled and rendered by David Robinson. piece which is sandwiched between a set of linear compression springs. The other ends of the springs are attached to the output of the actuator. A linear potentiometer measures the ballscrew displacement with respect to the output shaft, thereby measuring the spring compression and giving an indication of the force output. On the specific SEA designed for M2(17), a simple analog PD controller is implemented to control the spring deflection. When the output of the actuator is clamped, a force control bandwidth of 30hz is observed. The actuator is capable of outputting 300 lbs and capable of resolving forces on the order of 1.5 lbs. Chapter 4 Robot Mechanical Design This chapter presents the design specifics of the bipedal robot M2. 4.1 General Robot Architecture The robot stands approximately 5 feet high and weighs 60 pounds. The robot has 12 active degrees of freedom. Table 4.1 lists the specifications for the joints of the robot. Power at each joint is the same due to the single actuator design employed for all the joints. The power to the individual degrees of freedom of the ankle joint is limited by the power of the other. The robot joint ranges of motion were chosen based on data from humans as well as the robot Spring Flamingo and preliminary dynamic computer simulations. 4.2 4.2.1 The Design Overall Structure A photo of the robot and a joint schematic view are shown in Figure 4-1. The leg of the robot has six active degrees of freedom plus an optional passive degree of freedom in the foot. The vertical axis, Z, is the yaw axis. The X axis is the roll axis and the Y axis is the pitch axis. The hip has three degrees of freedom. These three degrees of freedom are made up of a universal joint (yaw and roll) followed by a pin joint (pitch). The pitch pin joint is offset slightly(about 2cm) from the yaw and roll axes. The frontal plane dimensions of the robot are shown in Figure 4-2. The dimensions are very close to the dimensions for a 50th percentile US male as given by Whitney(2). The ranges of motion are adapted from robot simulations and data found in Rose, et al.(18), Winter(20), and Kapandji(7). hip(pitch) hip(roll) hip(yaw) knee(pitch) ankle(pitch) ankle(roll) deg 80,-30 30,-20 30,-15 80,0 45,-20 20,-20 rad/s 7.3333 6.8 5.5 8.8 8.8 7.3 Nm 50 59 67 42 88* 100* Drive Type Pulley Push-rod Push-rod Push-rod Push-rod Push-rod Table 4.1: Robot Joint Specifications. Torque and rad/s numbers are given for maximum moment arm. Power, torque, and velocity are symmetric due to the actuator. *The ankle roll and pitch are not independent. Their maximum values can not be applied simultaneously. 19 20 CHAPTER 4. ROBOT MECHANICAL DESIGN Sagittal Frontal 44 Transverse Z - yaw Y - pittch X - roll Figure 4-1: A photo of the completed robot and a joint schematic view of the robot. The schematic shows active degrees of freedom only. The optional passive toe joint is not shown. CHAPTER 4. ROBOT MECHANICAL DESIGN 21 -60.00 16.00 7.25 (Hip Spacing) Hip Universal (Yaw, Roll) 40.00 37.75 37.00 Hip Knee Pitch Axis Pitch Axis / -1 20.00 4.50 Shin and Thigh Width Ankle Universal (Pitch, Roll) I 4.00 3~ 00 0 Figure 4-2: The dimensions of the biped in the frontal plane. The body and links are approximately axially symmetric about their longitudinal axis. Dimensions are in inches. CHAPTER 4. ROBOT MECHANICAL DESIGN Body Part/Area Shin & Foot (x2) Thigh (x2) Ab/Pelvic Arm (x2) Thorax to Head Human 6% 10% 27% 5% 31% 22 Biped Robot 13.5% 11% 51 % NA NA PDW 10% 15% 50% NA NA Table 4.2: Approximate distribution of mass in humans, the biped M2, and McGeer's kneed passive dynamic walker(PDW). Human data adapted from Dempster and Gaughran (3). Robot weight distribution is driven primarily by actuator locations. Each actuator is approximately 1.2kg(2.5 lbs). The mass distribution of the robot is dominated by the location of the actuators within the links. As a result, the robot's mass distribution is centered lower than an average human's. Table 4.2 shows the percentage mass distributions for an average male, M2, and a planar passive dynamic walker(10). The robot mass distribution is closer to that of a planar passive dynamic walker than to that of a human. Due to successful computer simulations(16), it was not necessary to add additional weight to the torso in order to put the proportions more in line with a human. 4.2.2 Actuators The actuators used in the robot are 90W, 1.2KG Series Elastic Actuators(17). They are capable of a maximum force of roughly 1320N (3001bs) and a maximum speed of roughly 0.28 m/s (11 in/s). The actuators have a force control bandwidth of 30Hz. Linear actuators where chosen over rotary actuators due to the available space in the robot. Linear actuators allowed for placement along the longitudinal axis of the leg links. The actuators are symmetric in their power, speed, and force capabilities. 4.2.3 Ankle The ankle of the biped is a universal joint. The pitch axis is followed by the roll axis. This is a slight deviation from the structure of the human ankle. The human ankle is often likened to a universal joint where the second axis is at 45 degrees to the first rather than at 90 degrees(7). For engineering simplicity we use a universal joint with orthogonal axes. The instantaneous power requirement for ankle pitch is the greatest. The actuators were placed in a configuration so they can act together in the pitch direction. Photos of the ankle are shown in Figure 4-7 and a schematic of the ankle and its actuators are shown in Figure 4-3. The ankle has two series elastic actuators placed along the longitudinal axis of the shin. The actuators are mounted by a universal joint near the top of the shin and attached to the foot by a ball and socket joint (rod-end). This is a linkage variation of a standard geared differential. When the actuators push in unison, a moment is generated about the pitch axis. When they push in opposite directions, a roll moment is generated. 4.2.4 Foot Two different feet were designed for the robot. One foot is a simple rectangular design with four single axis load cells residing at each of the corners. This foot closely resembles the foot that was used in computer simulations in the lab. Another more involved foot was designed in order to explore the roll of the toes in walking. CHAPTER 4. ROBOT MECHANICAL DESIGN 23 A Actuato Y axi E 0 X axi Ball Joint 0 Figure 4-3: A schematic of the ankle joint actuation scheme. The axes shown are fixed to the center of the universal joint. The points A,E, and 0 are referenced in Appendix A. Heel Ankle Joint .19 Toe 2.882 . 8 8Joint ont A_ Figure 4-4: The dimensions of the biped foot with passive toe joint. The X's represent the location of the load cells. The more intricate second foot of the biped robot contains a passive joint which is modeled after the toe of a human. The joint is believed to smooth the center of mass trajectory of the body during a walking cycle(18). The toe joint is simply a pin joint with two limit stops and a soft return spring. Ground contact and sensing on the foot consists of four single axis load cells. One cell is placed at the heel and three cells are placed in a triangle at the toe/ball of the foot. The three cells in the toe are all constrained to the same plane. The three toe contact points can rotate about the foot Y-axis with respect to the heel contact point. The layout of the sensors can be seen in Figure 4-4. Standard through-hole button load cells are used. There is a rubber bumper which contacts the ground roughly 0.875" in diameter attached to each load cell. On the simple four point foot there is a rectangular pastic piece with a 0.25" piece of neoprene for grip and shock absorbtion. This can be seen in Figure 4-7. Single axis load cells were chosen over a six axis sensor because of their size and weight, and chosen over strain gauges because of their ease of use and quick replaceablility. On the more complicated biped foot, force control and a passive toe joint are the reasons the four contact points of the foot are not over-constrained. Since ankle roll is force controlled rather than position controlled, it can adjust itself so the three points of the toe lie flat. The passive toe 24 CHAPTER 4. ROBOT MECHANICAL DESIGN Mr Yaw R0 0 L YL Body irame Roll Pitch My Ar Thigh Figure 4-5: A schematic of the biped hip. The pitch actuator is not shown. It lies along the axis of the thigh. Figure 4-6: A photo of the biped thigh illustrating the hip pitch cable drive system. joint(a pitch joint) then allows the fourth point on the heel to lie flat as well. 4.2.5 Hip The biped hip has three degrees of freedom. The joint consists of a universal joint followed by a slightly offset pin joint. A schematic of the hip is shown in Figure 4-5. The yaw axis is first and the the yaw actuator is mounted to the body frame with a pin joint. The roll actuator is next. Since its attachment point passes through the roll angle, it is mounted to the body by a universal joint. Its endpoint is attached by a ball and socket joint. The pitch actuator, which is not shown, lies along the longitudinal axis of the thigh. It is the only actuator which is attached using a cable and pulley rather than a rod-end. The range of motion of the hip pitch joint is the largest. The moment arm changes associated with a drive arm would be too great at the extents of the pitch motion. At sixty degrees from the perpendicular drive position, the moment arm would be half its original length. CHAPTER 4. ROBOT MECHANICAL DESIGN 25 Figure 4-7: The ranges of motion on the robot ankle joint. The ankle roll is symmetric(+- 20 deg). 4.2.6 Knee The robot knee is a simple pin joint. The joint is actuated by a SEA located in the thigh. Two photos demonstrating the range of motion of the knee can be seen in Figure 4-8. CHAPTER 4. ROBOT MECHANICAL DESIGN Figure 4-8: The range of motion of the robot knee. The knee has 80 degrees of motion. 26 Chapter 5 Electronics and Control Systems 5.1 Electronics Overview The basic electronic subsystems of the robot are shown in Figure 5-1. The robot is powered by a 48 Volt power supply. There is also an Ethernet connection not shown in the figure which can be used to load control code and retrieve data from the on-board computer. The circuit boards are summarized in Table 5.1. The sensors are summarized in Table 5.2. All signals are sent and received differentially between the computer and the analog boards. 5.1.1 48 Volt bus All the electronics on the robot receive power from a 48 Volt bus. The current setup has the robot connected to several offboard 48V power supplies. All the electronics were designed with this power bus in mind. The voltage choice was dictated by the brushless motor amplifiers. It was also chosen because it is a standard voltage and the robot will eventually be augmented with batteries for future autonomous demos. 5.1.2 Robot Sensors The robot is equipped with a total of 33 sensors. There are 12 rotary potentiometers that are used to measure joint position and this is differentiated to give the joint velocity. The joint position measurements are relative displacements between joints. There are 12 linear potentiometers which measure the spring compression in the Series Elastic Actuators. These signals are local to the analog force control loop only. They are not used by the DSP in the control. There are 8 single axis load cells on the feet of the robot. These sensors are connected to the strain gauge conditioning board which amplifies and buffers the signal on its way to the DSP. There is a single Intersense Inertia Table 5.1: Circuit Boards on the Robot Motor Amplifiers DSP ANA074 ANA063 Analog Force Control Board Power Distribution Board Signal Conditioning Board IS-300 Signal Conditioner QTY 12 1 1 1 6 2 4 1 27 Voltage Input +48 +5 5,12 5,12 +48 +48 12 +12 Vendor Copley Controls Dideas Dideas Dideas Leg Lab Leg Lab Leg Lab Intersense CHAPTER 5. ELECTRONICS AND CONTROL SYSTEMS 28 Table 5.2: Sensors on the Robot Sensor Rotary Potentiometers Linear Potentiometers Single-Axis Load Cells 3-axis inclinometer QTY I Voltage Input 12 +-5 12 +-5 8 +-9 1 NA Vendor Bourns Novotechnik Transducer Techniques Intersense 48Volt bus Vesibla Snsrs Brushless Motor Amp Actuator Computer A/D and D/A C Analog PID Regulated 5V Buffers S -Power -+-5 +- 12 Instrumentation L , Joint Pots Load Cells Figure 5-1: An overview of the biped electronics. Thick lines indicate power transfer and arrowheads indicate information flow. CHAPTER 5. ELECTRONICS AND CONTROL SYSTEMS 29 CubeTM which measure the roll, pitch, and yaw(magnetic) of the robot body. The Inertia Cube is connected to a IS-300 motion tracker unit which communicates with the DSP through a RS-232 serial line. Table 5.2 provides a summary of the robot sensors. Figure 5-2 contains an annotated photo of M2 with the sensor locations. Figure 5-2: A photo of M2 with annotations of electrical systems. 5.2 5.2.1 Custom Circuit Boards The Signal Conditioning Boards The signal conditioning boards are four layer printed circuit boards. They have a ground plane, a power plane, and two routing layers. The signal conditioning boards handle two 350 ohm wheatstone bridge sensors each. They have adjustable gain and offsets. 5.2.2 The Analog Force Control Boards The analog force control board provides two channels of PID force control for the Series Elastic Actuators and two channels of joint potentiometer buffering and differentiation. The analog force control boards have a 48 Volt power input and communicate with the DSP through differential amplifiers and receivers. The analog force control boards are four layer printed circuit boards. They have a ground plane, a power plane, and two routing layers. CHAPTER 5. ELECTRONICS AND CONTROL SYSTEMS 30 Figure 5-3: A photo of the biped strain gauge signal conditioning board. This board handles two strain gauges. There are a total of four of these boards on the robot. Figure 5-4: A photo of the analog force control and joint pot buffer board. There are six identical boards on the robot. CHAPTER 5. ELECTRONICS AND CONTROL SYSTEMS 5.2.3 31 The Analog Breakout Board The analog breakout board connects to the ANA070 and ANA064 analog input and output boards. It has no power and simply allows for the use of smaller connectors to easily distribute the 64 channels of analog input and output from the ANA070 and ANA064 boards. There are two 64 pin connectors which connect to the ANA064 and ANA070 boards respectively. Then there are multiple 3,5, and 10 pin connectors which connect to the signal conditioning boards and analog force control boards. The analog breakout board is a two layer printed circuit board. 5.2.4 The Power Distribution Boards The power distribution board has a 48 Volt input and outputs a variety of lower voltages. It appears in two places on the robot. There is one printed circuit for the two power distribution boards but there are two different DC-to-DC converters which are used when assembling the board. * Board Configuration 1 This board supplies power to the DSP (+5V) and two analog boards (+-12V, +-5V). The analog and digital grounds are isolated. e Board Configuration 2 This board provides power to the Intersense IS-300(+12V) and the four signal conditioning boards (+-12V). The power distribution boards are four layer printed circuit boards. They have a ground plane, a power plane, and two routing layers. 5.2.5 The DSP and Analog I/O M2 has a custom DSP system that was designed by Chris Barnhart at Digital Designs and Systems. The DSP is a Texas Instruments C-31. There are three circuits boards that make up the system. 1. DSP. Mulitple Serial Lines and Digital I/O. 2. 16 Analog Ins, 16 Analog Outs, and Ethernet. 3. 32 Analog Inputs. 5.3 Control Software Control code for the robot is written in C. It is compiled offline on a Unix machine and downloaded to the robot via Ethernet. The main robot control code runs at 500Hz on the DSP and sends desired forces to the analog boards. Currently, the control system treats the actuator and analog boards as a 'black box' force source. This means it is assumed that the desired force sent out to the actuator is the actual force applied to the joint. This is true within the realm of frequencies needed for walking(less than 15Hz). The analog boards have PD control loops for the Series Elastic Actuators. The analog boards also buffer and differentiate the joint potentiometers and send the information to the DSP. This is similar to the electronics used for Spring Flamingo. The main differences are the addition of Ethernet for faster communication with the outside world and differential send and receive for signals within the robot. Bibliography [1] Jesper Adolfsson, Harry Dankowicz, and Arne Nordmark. 3-d stable gait in passive bipedal mechanisms. Proceedings of 357 Euromech, 1998. [2] Henry Dreyfus Associates. The Measure of Man and Woman. Whitney Library of Design, New York, 1993. [3] W.T. Dempster and G. Gaughran. Properties of body segments based on size and weight. American Journal of Anatomy, 1965. [4] J. Fowble and A. Kuo. Stability and control of passive locomotion in 3d. Proceedings of the Conference on Biomechanics and Neural Control of Movement, pages 28-29, 1996. [5] Mariano Garcia, Anindya Chatterjee, and Andy Ruina. Speed, efficiency, and stability of small-slope 2d passive dynamic bipedal walking. IEEE International Conference on Robotics and Automation, pages 2351-2356, 1998. [6] K. Hirai, M. Hirose, Y. Haikawa, and T. Takenaka. The development of honda humanoid robot. IEEE International Conference on Robotics and Automation, 1998. [7] Ibrahim Adalbert Kapandji. The Physiology of the Joints. Churchill Livingstone, 1982. [8] Benjamin Krupp. Design and control of a planar robot to study quadrupedal locomotion. Master's thesis, Massachusetts Institute of Technology, August 2000. [9] Tad McGeer. Passive dynamic walking. International Journal of Robotics Research, 9(2):62-82, 1990. Passive dynamic biped catalogue. [10] Tad McGeer. Symposium of Experimental Robotics, 1991. Proceedings of the 2nd International [11] Thomas A. McMahon. Mechanics of locomotion. Reasearch, 3(2):4-28, 1984. The International Journal of Robotics [12] Gill A. Pratt and Matthew M. Williamson. Series elastic actuators. Conference on Intelligent Robots and Systems, 1:399-406, 1995. IEEE International [13] J. Pratt, P. Dilworth, and G. Pratt. Virtual model control of a bipedal walking robot. IEEE International Conference on Robotics and Automation, pages 193-198, 1997. [14] Jerry E. Pratt. Virtual model control of a biped walking robot. Master's thesis, Massachusetts Institute of Technology, August 1995. [15] Jerry E. Pratt and Gill A. Pratt. Exploiting natural dynamics in the control of a planar bipedal walking robot. Proceedings of the Thirty-Sixth Annual Allerton Conference on Communication, Control, and Computing, pages 739-748, 1998. [16] Jerry E. Pratt and Gill A. Pratt. Exploiting natural dynamics in the control of a 3d bipedal walking simulation. Proceedings of the International Conference on Climbing and Walking Robots (CLAWAR99), 1999. 32 BIBLIOGRAPHY 33 [17] David W. Robinson, Jerry E. Pratt, Daniel J. Paluska, and Gill A. Pratt. Series elastic actuator development for a biomimetic robot. IEEE/ASME International Conference on Advanced Intelligent Mechatronics, 1999. [18] Jessica Rose and James G. Gamble. Human Walking. Williams and Wilkins, 1994. [19] Mark Roshiem. Robot Wrist Actuators. John Wiley and Sons, Inc., 1989. [20] D. A. Winter. Biomechanics and Motor Control of Human Movement. John Wiley and Sons, Inc., New York, 1990. [21] Jinichi Yamaguchi, Eiji Soga, Sadatoshi Inoue, and Atsuo Takanishi. Development of a bipedal humanoid robot - control method of whole body cooperative dynamic biped walking. IEEE International Conference on Robotics and Automation, pages 368-374, 1999. Appendix A Joint Math Since all of M2's rotary joints are actuated by linear actuators, transformations are needed to get from joint torques to actuator forces. These are dependent upon the joint layout and actuation scheme. If the force is known, the torque is somewhat easily computed using the formula, T = ix F. operation can be rewritten as a matrix multiplication T = AF xF The cross product T = where A is a singular matrix. 7 = r XF j i rI r2 F1 F2 k r3 F3 = 0 -r 3 r2 r3 0 -ri -r2 r1 0 f = AF (A.1) However, if the cross-product is written as 7 =R Fl sin(O) then we can easily invert. In the case of most of the robot joints, this requires use of the arctan function or the law of cosines to find the angle 0. In general, the direction of F is fixed by the geometry of the joint and F1 is the quantity of real interest. A.1 Knee Joint The knee joint is a single degree of freedom rotary joint allowing relative motion between the shin and the thigh. When all the joints of the robot are zero(it is standing with locked knees), the knee axis is parallel to the global Y axis. Rotation about the knee joint is referred to as pitch. The knee actuator is connected to the knee joint via a push rod of length 1OA1 = rk at the shin and a fixed pin joint at the thigh. The knee joint has three points of interest which we will use for the derivation of the transformation. The knee pivot 0, the actuator pushrod attachment A, and the actuator mounting pivot M. The robot knee joint and points can be seen in Figure A-1 and a simple line drawing is seen in Figure A-2. r= r x F (A.2) rk sin(ZOAM)Fknee The actuator force required given Tk is Fke7 nee where Fknee is a scalar and ZOAM =Of ixed + (A. 3) rk sin(ZOAM) ZOAM can be defined as follows Ok - ZAM Of ixed + Ok - 34 arctan r sin(Ofixed + 9 k) L 1 + r sin(Ofixed - + Ok) (A.4) 35 APPENDIX A. JOINT MATH Figure A-1: The robot knee joint with superimposed lines and points. Points 0, A and M all refer to pin joints. 0 is the knee joint. M is where the actuator is mounted to the thigh and A is where the actuator is attached to the shin. L Oknee A M / Ofixed LMA Figure A-2: A line drawing of the knee for the calculation of knee actuator desired force. The actuator is the line segment MA. This drawing also pertains to the geometry of the hip and ankle joints but the hip and ankle actuators have motions out of the plane whereas the knee actuator is always in the plane perpendicular to the knee axis. APPENDIX A. JOINT MATH 36 X x r r A2 $ Al ry Figure A-3: A simple view of the actuation of the robot ankle. This is a tranverse plane slice of the robot ankle. Point 0 is the intersection of the X and Y axes as well as the center of the ankle universal joint. Points Al and A2 represent the attachment points of the two actuators respectively. Forces in the actuators create torques about both the X and Y axes. Joint rotations change the relative lengths of the X and Y projections(r, and ry) of the moment arms, therefore affecting the torque to force transformation. The angle between the shin and the thigh is Ok and the constant, Of ixed, is the angle between the shin and the segment OA. It is also possible to derive the equations avoiding the inverse tangent by using the law of cosines. It would be possible to simplify the equations a bit by assuming the actuator is always parallel to the thigh, i.e. ZAM = 0. This simplifies the equations and shouldn't reduce accuracy much considering that L, > L 2 . Equation A.3 then becomes (A.5) Fknee = rk sin(Of ied + Ok) where Fknee is once again a scalar quantity. A.2 Ankle Joint The ankle joint is a universal joint(2 d.o.f.) allowing relative motion between the foot and the shin. When all of the joints of the robot are zero, the axes of the ankle joint line up with the global X and Y axes. The Y axis is proximal to the shin. Rotation about the Y axis is referred to as pitch and rotation about the X axis is referred to as roll. The math for the ankle is an extension of the math for the knee. We can consider the ankle as two decoupled cases of the knee joint. Then one can simply add the forces from Tr7oll and Tapitch. There is a slightly more complicated analogy to the knee in two planes of the ankle. The ankle roll considers what is happening in the XZ plane and the ankle pitch considers what is happening in the YZ plane. Both planes are coming out of the page in Figure A-3. Each plane looks similar to the knee diagram shown in Figure A-2. The main difference is that OA = r is a function of the other ankle angle. 37 APPENDIX A. JOINT MATH R Mr Yaw L Roll L Body trame Yaw Pich MY Ar Thigh Figure A-4: The robot hip joint schematic. Point 0 refers to the hip universal joint. The Z(hip yaw) and Y(hip roll) axes intersect at point 0. Point M, refers to the universal joint on the body where the roll actuator is mounted. Point A, refers to the ball joint on the thigh where the roll actuator is attached. Point MY refers to the pin joint where the yaw actuator is attached to body. Point Ay is the pin joint attachment of the yaw actuator to the yaw universal block. It is hidden in this schematic. A.3 Hip Joint A.3.1 Hip Pitch The math for the hip pitch is the simplest of all the joints since the hip pitch actuator is attached by a pulley. The desired torque at the joint(Thp), leads to the force(fhp) command to the hip pitch linear actuator. fA - (A.6) Thp Thippitch The transformation from actuator velocity to joint velocity is quite simple as well. Whp A.3.2 (A.7) Velhp Hip Roll and Yaw The yaw actuator transformation is identical to that of the knee actuator except for the addition of a small term which can be ignored with little affect. The actuator force required given Thya, is F -ya' Thyaw sin(/OyAyMy) 6 hroll (A.8) where E is a small factor due to the torque applied to hip roll which is a function of the hip roll and yaw angles. Oy, Ay, and My are defined as they were in the case of the knee. APPENDIX A. JOINT MATH 38 The actuator force required given Throll can be simplified to Fhroll =hr hr (1 + Ehyaw) (A.9) sin(/ZOhrAhrMh,) The exact equation for the hip roll incorporates the yaw angle. Since the hip roll actuator attachment point Ahr is attached to the leg below the yaw degree of freedom, the points Ohr, Ahr, and Mhr do not always lie within the plane perpendicular to the roll axis as in the case of the knee joint where they are fixed in the plane perpendicular to the knee axis. When the roll actuation plane(plane formed by the three points Ohr, Ahr, Mhr) is skewed with respect to the roll axis, a small torque will be contributed to the yaw axis. This is where the term term in it. Ehroll comes from in Equation A.8 and this is why the hip roll equation has the Chya, Appendix B Electrical Schematics This Appendix contains the electrical schematics for all the custom circuit boards used on the robot. The basic functionality of the boards and their role in the overall robot is decribed in more detail in Chapter 5. There are six pages for the analog force board, 2 pages for the signal conditioning board, 1 page for the analog breakout board, and 1 page for the power distribution board. 39 5 4 1 3 1 I 2 5 TP1 PB1 Test Pcit plus12 J1 +12 o:FST GC OUT BC1 DC/DC lu f H -PNPT CONVERTER CN" +-12V 48INCONN BC2 luf SGND DFC10U48D12 REG1 7N SGNDO GND2 TP3 I Test +ciOUT GND1 GND20 GND2 GND3 GND4 2 Actuator CD PC2 10uf I4340 6 2 2 Joint Pot DSP CD -in- + Mn P Si gnals out to -Vo A 4Vo JFP1 0 A-A- Ii SigaP Signal. s--~r-r -5 ioinl- W" enomnd . F-A>--- 01 0~ B JjPO IDSP 0 CD V,1 A // CA-- out to 2 Joint Pot Derivatives e from DSP J2 'O c Command TP2 minus12 - -5 JFP2 GND t- 4pin-pot + D-o L7 o .>. 4pinot Signal CD RV+ 0 el CS CD t 1e 3o 4pinpot JJP2 B+rmRV- OPIN copleystyle 2 Current Commands on their way to Copleys zsvs Signal 0 +53) GND REG2 4pin-pot SPIN-copleystyle nl> ':-]I43314 -C ritle 10uf MIT LEG LAB, BIPED FORCE BOARD T4minus5 3i I Document Number A Date: 5 -I 1 4 -- 1 3 POWER AND CONN Tuedav. Dppmbpr 2 [ev ECTORS 21 .1999 {Re, heet of 1 de} 6 1 A) 5 1- 4 3 TP5 111 FC1 0 1 5 7k5k f R3 IA 5k R4 + LM3 24 5k 0. Il 10k BC3 1B LM3 24 R5 C POT 20k R6 LM3 24 5kTP7 R7 t 5k LM3 204 1' 10k BC4 R C luf BC5 CI 0 luf -Z-- R8 -Mnse P << ...... ....... 5k 5k C'.9 CDt 0 .1 RIO C3 UD2 4- ---------5k 2A f2A 2 CD Ril 10k INA7137 BC7 FC2 I I II luf LM3 24 LM3 24 TP9 R12 R13 5k PO 20k R14 2B i BC8 5k 0 . luf LM3 24 TP10 5k TP11 R15 TP 12 '2 2C LMC LM324 10k Test poit . A U2D R16 P ritle MIT LEG LAB, BIPED FORCE BOARD LM324 5 5k im I A 5 - Document Number ate 3 1 'c d e ) -{Re, and B FORCE ERROR, A ReWpn-sday 2 e DecebrO I1 -14-9~he 2 nf 1 6 II, I. I o ('UJ ~SI H .H HO H APPENDIX B. ELECTRICAL SCHEMATICS QI II, t V I OJ2 l H9 Figure B-3: Page 3 of 6 of the biped force board. ~ V. IH 0 H ... F U I C 42 II, 0 C H II, APPENDIX B. ELECTRICAL SCHEMATICS I ' + 00 0IO, 1 m \0, I Figure B-4: Page 4 of 6 the biped force board. 0,N 0 U P 0 OH 43 liIIfL I, I 1 5 2 C7 BC17 BC18 0 .033uf 0 <KUSA J 0. luf TP15 5k R138 . LM324 Sm5 Test Psi t V n 10 k +Sens- H~ D LM3 24 C 2 0 luf C8 -DRV134 BC BC20 RL2 It 0luf 0 .33uf RL10 50k R40 C9 Dv4j0.1uf 5k LL M 4 R41 SuF +SEse D3224 1k USD C) LM3 24 LED BC23 12 BC24 0 .033uf 0 . luf -0 IHT DRV134 Bc TP11 0 JA S+vo 5C 1.65 k 12+ R4 k0.1uf 4- P 6A 5k R43 1 6B+v r ,1n 10k LM3 24 LM3 24 Yi.. TP .2 - EC2 5 I > J7 --- - DRV134 luB2 0 . 33uf Sense BC26 C11 0. 1uf +sens-, Vc > 1 F.V .2-u 4C12 k 1.65 k RL 4 50k -" 5 -es lUF D33 IND 24 LEDIC2 DRV134 R46 LM3 24 1k A D4 ritle LED MIT LEG LAB, BIPED FORCE BOARD ,im A 9 Wednesday. 2ate December 3 ev Document Number JOINT POSITION AND VELOCITY 2 4. 199Ihpet- 1 {ReI 5 o 1 6 del 1 RL5 50K D5 LED JMP1 RL6 D R4 5k JUMPER UlA 500ohm RL7 D6 LED 50K BC29 3--I CD << 0 RL8 uLED R48 M3 24 : -0 JUMPER 5k + UB CIO 50h ' BC30 CD - LED b- RL9 ui 0 01 D7 4 FBSJMP2 open -0 4- - D9 c-F LED CD JMP3 CD JUMPER RL10M32 R4 5k I k IU7C B 3--F) 0 LED 3--I CD RL11 0 open c-i D11 LEO JMP4 RL12 < - JUMPER 5k _ + M324 U7D RS 1 k D12 LED i7le MIT LEG LABORATORY, BIPED 3im A FORCE BOARD [ev Document Number {Re LED MONITORS Wenesday, December 19. 1991bet 6 o 6 C0 de) 4 5 2 3 Vexc Qut , Sense-Hiql + TnpuL) t , .-Inpu Sense-Low, . S gn .- zy V +1 it i U1A Inu LF347 m rx 1 2J t-an For Half-Bridge Completion: 1 - Connect pin 2 and pin 25 2 - Leave connector -Input open BRIDGECONTI STRAINCONN H_7 12V j3 U2 t t Strain Gain Adju sain Rl . 2e:1Hi! CD Hal Sign al npt 0 nput R3 R30, 1 0 CB Sense--Hgq! --ipuj - 14.17F Conditioner Un1filLeired A Exc . AC j -Ref. I A;Ij 2 Fef1. Ou kfej I Offszer_ OupuL Idt [:set Ad-i. idt'; Adi. BS 1 Vout Fi Ite red tof 2 pu 2 1," R2 la5k _ Sri n) t" train GND 1es-Low Sensa-Low f-Bridgce Ccomp Ie J4 e -npu -- +IT I St r in Gage +9V reg eg-9V xcuxV I - 7 0u ex nPU C) _CONN BRIDGECONN +1 V ,7s FRe. + Vs A-+ C;-mmlr 2 -V_ 4- 1B31 -9V reg 1100 1o0 0 pF 0 -12V +12V+9V +1 0q +1 + V IN i. I N R6 470 R7 620 D2 D3 D4 LED % LED -90UT LED) LED FLAMPWRCONN 12V z .luF O16 -9V reg -9 eg [itle M2 /M4 -12V 3im A 4 -2 MIT Leg Laboratory 102164 5 1 Di GND - R5 470 luF +90UT C7 reg9V regl2V +9V reg R4 620 V C6 +9V reg U3 V 3 fre Protoptype Strain Gage BoardI ev Document Number Auaust 14, 199P Fiav 2 heet 1 1 of 2 4 1 4 5 +12V U1B LF347 For Half-Bridge Completion: 1 - Connect pin 2 and pin 25 2 - Leave connector -Input open Sq Up Vexc +5Input R8 (C Str ain Gain Adju Input .9 - Gain Cr2 -,ltH -'na Sense Low HaIo-ridge Comple Strain Gage Signal Conditioner +9V reg nPut R10 O Inpu Off st Output Off-e7 50k e-e 2 Sense B~andidth -Vou Adj. Filtrred 2Ref. Ad_1 2 +Vc -12V Sam +12V - U1C F \4. LF347 21> R9 Rf. d CHst Aj x- k OU RLe +1 V Cr2 + * Cmm - vt +12V B31 -9V U1D -12V reg -12V LF347 * Il 01 12V A itle M2/M4 Prototype Strain Gage Board [im A Dat,: 5 I 4 I3I 3 ev Doc-ent Number IDoc} 1 Friday. Ailaust 14, 21 1998 heet- 2 of 2 COq 5 1 4 7,M D 2 1 4 IN-R-FOOT 1 1;2+ 4 1 A+ OOT2 1 T _I-I-NOOT2 A A A+- A A AA 2N-- AC2 1 1 n 1 19 21 AA 0 C) n - o 1e 4A,~ 1i 22 21 23 25 s 11 A 24 23 2 4Al 6 ! A124 a n ,A 1 -) A 2C1 SA g ra' 0 4 A - "6 01436 AD21 91 17 A E-j+ C2 41 43 56 2 26 AV-124 - AR 28 344 4l 36 A 38 51 8a A.C 63 1- D , P A 11 SPIN A- H copleystyle SPIN -A eopleystyl A- '+ AD1 5,2 AGU Dek+, A- 5PIN__copleystyle QTJT- 50 - SPIN copleystyl e 5PIN-copleystyle GN HIN1 GH1 A+ -GND1 PINcopleystyle n.T-P IGH2 A* A-- -F+ 60 6 SPIN HEADER64 e copleystyle OUT-13(DY1 5PIN-copleystyle DY GND3 A+ GND2 F3C GND 2 AG A+V NVN- B- IN-TH IGH2 GNDl 5PIN-Copleystyle AC6 17-C! 2+ 1 - ,2 A+ IN-BOI IN-PBQ 'Y2 A+ A- ADD.2'21+ A - 1 M All" IAVCA+ -- c 5PINcopleystyle IN-THIGH1 ADR A+ A- e A- % 2n30 40 542 6.1 HEADER64 GND1 5PIN-copleystyle C1AD9- 42 D7 D-4 64 63 Zoq 2 AB+ A- 24 4-7 49 55 5 SC A+ A+. SPTN-Copleystyle 5EE64 6, PIN copleystyle GN 42E 2- 1 -4 D G 21 t A3Cs '11 ,A e A- A ,,:2 20 22 r 215 c; , IA 3 0 10 SPINcopleystyl copleystyle ADC9 A1 1 nn+2 SPIN 5PIN-copleystyle 12 130 10 133 CD Np2A - AV+ 1 AV+ ""32 AV- AV-- AV- B+ GND A0PI c V+ .. -Colytl B + y e10PIN-copleystyle FF2 1(2 10PIN EN copleystyle 3- inC B+ ,- + G ND 2 BV+ 10PIN-copley style 10PIN-copleystyl 10PIN-copleystyle itle M2 BREAKOUT BOARD - Al2 GN6 3pincopley-style 5 -3pincopley-style e -~3pin-copley-styl 33pincopley-style ;ia A Uate: 4 3 ev (Re% Document Number (Doc} Monday, March 06, 2000 2 rheet 1 of 1 1 de) 5 4 3 2 31 TPO Too =.0t 1 ls2 0 sorq 1+NPUT 481NCONN T8 -INPUT1 DC/DC CONVERTER +-12V PC2 1 Ouf ND1 Test GND - Psi - -groundO C TP2 PC3 Tluf 3pin terminal block-ed1610 P t C-) minus12 H DFC1OU48D12 ~C PB2 Second powe r brick is either +5 AS + F77 dEJTetAMOD clnnei DFA6U48S5 U2 U1 Cti ground C) TP3t TP3 T +MpUT C) +12 single ended supply. t - DC /Dr., 3pin-terminal-block-ed6lO or 3pin 3pin tost Psi +LOt plus 5 or 12 U4 U3 Ch. C) J4 4. 0 raO 134 + 2pinterminal block-ed1609 J5 S0 REG1 TP4 2pin-terminal block-ed1609 T "; plus5 3pin -143406 T tenninal blocked1610 2 v PC5 10uf 3pin-terminal-block-ed16lO GND -OUT I43314 MIT PC6 Lea Laboratory tle Power Board, February 2000 10uf M 3i inus5 mP 55 Ii 4 4 I i A Le i1 1 Fev Document Number {Doc} aI 2 eray {Rex l ?n i- - del -L (0 Appendix C Suppliers and Costs This section contains a list of all the suppliers that were used in development of the robot. Digital Designs and Systems 3266 North Meridian Street Indianapolis, IN 46208 317-931-8190 http://www.dideas.com/ microcontrollers, a/d and d/a conversion, vision systems, ready built and custom designs Stock Drive Products 2101 Jericho Turnpike, Box 5416 New Hyde Park, NY 11042-5416 (516)328-3300 Mechanical Parts Berg 499 Ocean Avenue Box 130 East Rockaway, NY 11518 (516)596-1700 Mechanical Parts NOVOTECHNIK 237 CEDAR HILL STREET MARLBORO, MA 01752 (508) 485-2244 Potentiometers SMALL PARTS INC 13980 NW 58TH COURT PO BOX 4650 MIAMI LAKES, FL 33014-3115 (800) 220-4242 Mechanical Parts CENTURY SPRING COMPANY INC BOX 15287 222 EAST 16TH STREET 50 APPENDIX C. SUPPLIERS AND COSTS LOS ANGELES, CA 90015-0287 (800)237-5225 Springs Newark Electronics 41 Pleasant Street Methuen, MA 01844 (800) 463-9275 Electronic Parts REC ENGINEERING COMPANY(Bob) 20 HOPKINS STREET WILMINGTON, MA 01887-2210 (508)657-6517 Machining Eastern Tool(Joe) Somerville, MA (617)497-6703 Machining Transducer Techniques 43178 Business Pk. Dr. Temecula CA 92590 1-800-344-3965 Load cells. Intersense, Inc. 73 Second Avenue Burlington MA 01803 (781)-270-0090 Multi-axis inclinometer. Digi-Key Corporation 701 Brooks Ave. South Thief River Falls, MN 56701-0677 (800)344-4539 Electronic Parts Copley Controls Corporation 410 University Avenue Westwood, MA 02090 (617)329-8200 FAX: (617)329-4055 Amplifiers Cooner Wire Company 9265 Owensmouth Chatsworth, CA 91311 (818)882-8311 Flexible Wire 51 APPENDIX C. SUPPLIERS AND COSTS CFC, Inc. 179 Bear Hill Road Waltham, MA 02154-1001 (617)890-1878 FAX: (617)890-7098 MODEM: (617)890-7193 Circuit Board Fabrication Advanced Circuits Colorado, http://www.4pcb.com Circuit Board Fabrication, online ordering NSK -linear motion division Elmhurst, IL 60126-1016 ATTN: Sandy x2638 or Jackie x2677 tel:1-800-255-4773 fax:630-924-8197 Ballscrews Litton Poly-Scientific 1213 North Main Street Blacksburg, VA 24060 (828)837-5115 Attn: Barbara Smith x231 fax (828)837-0846 Brushless DC motors McMaster Carr BOX 440 NEW BRUNSWICK, NJ 08903-0440 (908)329-3200 Mechanical Parts QUALITY COMPOSITES INC 8385 S ALLEN STREET No.140 SANDY, UT 84070 (801)565-8003 FAX: (801)565-8225 Carbon Fiber Tubes Sava Industries, Inc. 4 N. Corporate Drive, P.O. Box 30 Riverdale, NJ 07457-0030 (201) 835-0882 Steel Cable, crimps and crimp tools. Tristar Plastics Shrewsbury, MA 800.874.7827x3203(mike rudel) fax 508.845.1200 52 APPENDIX C. SUPPLIERS AND COSTS 53 Rulon bushings W.S. Deans 10875 Portal Drive Los Alamitos CA 90720 714-828-6494 Robin Wet noodle wire US Sensor Corp 1832 West Collins Ave. Orange, CA 92867 714-639-1000 Terry ext 104 Thermal sensors for mo unting amps to heat sinks Tra-Con 45 Wiggins Ave. Bedford, MA 01730 1.800.872.2261 781.275.6363 Glue for glueing thermal sensors to amp heat sink. Tower Hobbies PO Box 9078 Champaign, IL 61824-9078 1-800-637-6050 Batteries and charger C.1 Costs This section contains the costs associated with the robot M2. Costs and quantities given do not include spares. The general lab policy is to order 50 percent spares on everything. I think that anyone else developing a similar robot should do the same. See Table C.1 for details. APPENDIX C. SUPPLIERS AND COSTS Component Actuator, Amp Custom Computer CFRP frame Machining Vestibular Misc Parts PCB's Load Cells TOTALS 54 QTY 12 1 8 1 1 200 10 8 Each US $ 1500 10,000 300 30,000 10,000 20 1,000 450 Total US $ 18,000 10,000 2500 30,000 10,000 4000 10,000 3600 88,100 Table C.1: Basic robot budget. See Robinson et al.((17)) for more detail on the actuator. This budget does not include prototyping or development costs. Part quantities and individual costs are not necessarily meant to imply identical parts but rather to give an average price for all units of a certain type.