#VRML_SIM R2025a utf8 # license: Copyright Cyberbotics Ltd. Licensed for use only with Webots. # license url: https://cyberbotics.com/webots_assets_license # documentation url: https://webots.cloud/run?url=https://github.com/cyberbotics/webots/blob/released/projects/robots/robotis/darwin-op/protos/Darwin-op.proto # keywords: robot/legged # Robotis' DARwIn-OP is an open platform, miniature humanoid robot used for research, education and outreach. # The DARwIn-OP model contains principally: # - the 20 DOF # - LEDs # - accelerometer # - gyro # - camera # - realistic physics # template language: javascript EXTERNPROTO "webots://projects/joints/protos/HingeJointWithBacklash.proto" PROTO Darwin-op [ field SFVec3f translation 0 0 0.227 # Is `Pose.translation`. field SFRotation rotation 0 0 1 0 # Is `Pose.rotation`. field SFString name "DARwIn-OP" # Is `Solid.name`. field SFString controller "motion_player" # Is `Robot.controller`. field MFString controllerArgs [] # Is `Robot.controllerArgs`. field SFString window "" # Is `Robot.window`. field SFString customData "" # Is `Robot.customData`. field SFBool supervisor FALSE # Is `Robot.supervisor`. field SFBool synchronization TRUE # Is `Robot.synchronization`. field MFFloat battery [] # Is `Robot.battery`. field SFBool selfCollision FALSE # Is `Robot.selfCollision`. field SFColor plasticColor 0.301961 0.301961 0.301961 # Is `Material.plasticColor`. field SFInt32 cameraWidth 160 # Is `Camera.width`. field SFInt32 cameraHeight 120 # Is `Camera.height`. field SFNode jersey NULL # Extends the robot with a jersey: typically RobotisJersey.proto. field SFInt32 channel 0 # Defines the channel for the `Emitter` and `Receiver` devices. field SFBool backlash FALSE # Enables backlash on all joints. field MFNode bodySlot [] # Extends the robot with new nodes in the body slot. field MFNode headSlot [] # Extends the robot with new nodes in the head slot. field MFNode leftFootSlot [] # Extends the robot with new nodes in the left foot slot. field MFNode rightFootSlot [] # Extends the robot with new nodes in the right foot slot. field MFNode leftHandSlot [] # Extends the robot with new nodes in the left hand slot. field MFNode rightHandSlot [] # Extends the robot with new nodes in the right hand slot. #protected hiddenField SFString _model "DARwIn-OP" hiddenField SFString _description "Robotis' DARwIn-OP modeled by Fabien Rohrer" ] { %< const has_jersey = fields.jersey.value; const enable_backlash = fields.backlash.value; // tune backlash on joints const backlash = 0.01; const backlash_head = backlash; const backlash_neck = backlash; const backlash_shoulder = backlash; const backlash_arm_upper = backlash; const backlash_arm_lower = backlash; const backlash_pelv_y = backlash; const backlash_pelv = backlash; const backlash_leg_upper = backlash; const backlash_leg_lower = backlash; const backlash_ankle = backlash; const backlash_foot = backlash; >% Robot { translation IS translation rotation IS rotation battery IS battery children [ DEF BODY_SLOT Group { children IS bodySlot } Pose { rotation 0.5774 0.5773 0.5773 2.0944 children [ DEF JERSEY_SLOT Slot { type "robotis jersey" endPoint IS jersey } ] } Pose { rotation 0.5774 0.5773 0.5773 2.0944 children [ DEF DBodyShape Shape { appearance DEF PLASTIC_APPEARANCE PBRAppearance { baseColor IS plasticColor roughness 0.4 metalness 0 } geometry IndexedFaceSet { coord Coordinate { point [ 0.0189393 -0.0980656 0.0268584 -0.0189393 -0.0980656 0.0268584 0.0329651 -0.0785909 0.032466 -0.0329651 -0.0785909 0.032466 0 -0.0980656 0.0268584 0 -0.0785909 0.032466 0 -0.0684064 0.034421 0 -0.0628994 0.0351729 0 -0.048721 0.0357745 0 -0.0344986 0.0356692 0 -0.0215196 0.0332293 0 0.0056817 0.0204932 0 0.0192564 0.0114116 0 -0.0980656 0.0228699 0.0191471 -0.0980656 0.0228699 -0.0191471 -0.0980656 0.0228699 0.0472058 -0.0628994 0.0351729 -0.0472058 -0.0628994 0.0351729 0.0481432 -0.0508762 0.0356895 -0.0481432 -0.0508762 0.0356895 0.048433 -0.0344986 0.0356692 -0.048433 -0.0344986 0.0356692 0.048433 -0.0215196 0.0332293 -0.048433 -0.0215196 0.0332293 0.048433 -0.0079189 0.0277709 -0.048433 -0.0079189 0.0277709 0.048433 0.0056817 0.0204932 -0.048433 0.0056817 0.0204932 0.048433 0.0192564 0.0114116 -0.048433 0.0192564 0.0114116 0.0461024 -0.0684064 0.034421 -0.0461024 -0.0684064 0.034421 0.0254606 -0.0905876 0.0293183 -0.0254606 -0.0905876 0.0293183 0 -0.0905876 0.0293183 0.0254606 -0.0905876 0.0228699 -0.0254606 -0.0905876 0.0228699 0.0329651 -0.0785909 0.0228699 -0.0329651 -0.0785909 0.0228699 0 -0.0905876 0.0228699 0.0565076 -0.0905876 -0.0267561 -0.0565076 -0.0905876 -0.0267561 0.0565076 -0.0514098 -0.0764782 -0.0565076 -0.0514098 -0.0764782 0.0565076 -0.0212185 -0.0764782 -0.0565076 -0.0212185 -0.0764782 0.0565076 -0.0063517 -0.0764782 -0.0565076 -0.0063517 -0.0764782 0.0565076 0.0256694 -0.0620687 -0.0565076 0.0256694 -0.0620687 0.0565076 0.0273448 -0.0374196 -0.0565076 0.0273448 -0.0374196 0.0485225 0.02405 -0.0331857 -0.0485225 0.02405 -0.0331857 0 0.0256694 -0.0620687 0 0.0273448 -0.0374196 0 0.02405 -0.0331857 0.0504399 -0.0876542 -0.0306215 -0.0504399 -0.0876542 -0.0306215 0.0504399 -0.0559821 -0.0707385 -0.0504399 -0.0559821 -0.0707385 0.0504399 -0.0875412 -0.0707385 -0.0504399 -0.0875412 -0.0707385 0 -0.0875412 -0.0707385 0 -0.0559821 -0.0707385 0 -0.0876542 -0.0306215 0 -0.0514098 -0.0764782 0 -0.0905876 -0.0266996 0.0565076 -0.0628994 -0.0331857 -0.0565076 -0.0628994 -0.0331857 0.0565076 0.0262925 -0.0529012 -0.0565076 0.0262925 -0.0529012 0.0565076 -0.0063517 -0.0591835 -0.0565076 -0.0063517 -0.0591835 0.0565076 -0.0027423 -0.0545215 -0.0565076 -0.0027423 -0.0545215 0.0565076 0.0019197 -0.0530176 -0.0565076 0.0019197 -0.0530176 0 -0.0063517 -0.0764782 0.0626992 -0.0212185 -0.0764782 -0.0626992 -0.0212185 -0.0764782 0.0626992 -0.0628994 -0.0331857 -0.0626992 -0.0628994 -0.0331857 0.0626992 0.0273448 -0.0374196 -0.0626992 0.0273448 -0.0374196 0.0626992 0.0262925 -0.0529012 -0.0626992 0.0262925 -0.0529012 0.0626992 -0.0063517 -0.0764782 -0.0626992 -0.0063517 -0.0764782 0.0626992 -0.0063517 -0.0591835 -0.0626992 -0.0063517 -0.0591835 0.0626992 -0.0027423 -0.0545215 -0.0626992 -0.0027423 -0.0545215 0.0626992 0.0019197 -0.0530176 -0.0626992 0.0019197 -0.0530176 0.0565076 -0.0628994 0.0295758 -0.0565076 -0.0628994 0.0295758 0.0565076 -0.0296561 0.0295758 -0.0565076 -0.0296561 0.0295758 0.0565076 -0.0215196 0.0270637 -0.0565076 -0.0215196 0.0270637 0.0565076 -0.0079189 0.0216054 -0.0565076 -0.0079189 0.0216054 0.0565076 0.0056817 0.0143276 -0.0565076 0.0056817 0.0143276 0.0565076 0.0152688 0.0052461 -0.0565076 0.0152688 0.0052461 0.0565076 0.0200374 -0.0331857 -0.0565076 0.0200374 -0.0331857 0.0626992 0.02405 -0.0331857 -0.0626992 0.02405 -0.0331857 0.0565076 -0.0296561 -0.0070197 -0.0565076 -0.0296561 -0.0070197 0.0565076 -0.0254794 -0.0151742 -0.0565076 -0.0254794 -0.0151742 0.0565076 -0.0181205 -0.0241241 -0.0565076 -0.0181205 -0.0241241 0.0565076 -0.0183194 -0.0331857 -0.0565076 -0.0183194 -0.0331857 0.0601226 -0.0296561 -0.0070197 -0.0601226 -0.0296561 -0.0070197 0.0609281 -0.0254794 -0.0151742 -0.0609281 -0.0254794 -0.0151742 0.0618122 -0.0181205 -0.0241241 -0.0618122 -0.0181205 -0.0241241 0.0626992 -0.0183194 -0.0331857 -0.0626992 -0.0183194 -0.0331857 0.0565076 0.02405 -0.0331857 -0.0565076 0.02405 -0.0331857 0.0524385 -0.0905876 0.0160386 -0.0524385 -0.0905876 0.0160386 0.0565076 -0.0905876 -0.0045579 -0.0565076 -0.0905876 -0.0045579 0.0329651 -0.0905876 0.0228699 -0.0329651 -0.0905876 0.0228699 0.0550535 -0.0905876 0.009958 -0.0550535 -0.0905876 0.009958 0.0464127 -0.0905876 0.0202971 -0.0464127 -0.0905876 0.0202971 0.0565076 -0.0628994 -0.0045579 -0.0565076 -0.0628994 -0.0045579 0.0550535 -0.0628994 0.009958 -0.0550535 -0.0628994 0.009958 0.0524385 -0.0628994 0.0160386 -0.0524385 -0.0628994 0.0160386 0.0464127 -0.0628994 0.0202971 -0.0464127 -0.0628994 0.0202971 0.0162656 -0.0079189 0.0277709 -0.0162656 -0.0079189 0.0277709 0.0200508 0.0056817 0.0204932 -0.0200508 0.0056817 0.0204932 0.0131798 -0.01695 0.0314025 -0.0131798 -0.01695 0.0314025 0.0131798 -0.0171972 0.0298751 -0.0131798 -0.0171972 0.0298751 0.0162656 -0.0080763 0.0264755 -0.0162656 -0.0080763 0.0264755 0 -0.0080763 0.0264755 0 -0.0215519 0.0315845 0.0344736 -0.0344986 0.0356692 -0.0344736 -0.0344986 0.0356692 0.0326947 -0.0439508 0.0357404 -0.0326947 -0.0439508 0.0357404 0.048433 -0.026173 0.0341371 -0.048433 -0.026173 0.0341371 0.0524828 -0.0320698 0.032613 -0.0524828 -0.0320698 0.032613 0.0523586 -0.023864 0.0309799 -0.0523586 -0.023864 0.0309799 0.0520988 -0.023936 0.0292534 -0.0520988 -0.023936 0.0292534 0.0521645 -0.0322226 0.0307246 -0.0521645 -0.0322226 0.0307246 0.0481146 -0.0263258 0.0322488 -0.0481146 -0.0263258 0.0322488 0.0323763 -0.0441037 0.0338521 -0.0323763 -0.0441037 0.0338521 0.0341552 -0.0346514 0.0337809 -0.0341552 -0.0346514 0.0337809 0.0481146 -0.0346514 0.0337809 -0.0481146 -0.0346514 0.0337809 0.0389696 -0.048721 0.0357745 -0.0389696 -0.048721 0.0357745 0.0342575 -0.0594493 0.0353214 -0.0342575 -0.0594493 0.0353214 0.0482032 -0.0445659 0.0357406 -0.0482032 -0.0445659 0.0357406 0.0524493 -0.041828 0.0325327 -0.0524493 -0.041828 0.0325327 0.0529358 -0.0478391 0.0321861 -0.0529358 -0.0478391 0.0321861 0.0482032 -0.0445659 0.0341924 -0.0482032 -0.0445659 0.0341924 0.0524493 -0.041828 0.0309845 -0.0524493 -0.041828 0.0309845 0.0481432 -0.0508762 0.0341413 -0.0481432 -0.0508762 0.0341413 0.0342575 -0.0594493 0.0337732 -0.0342575 -0.0594493 0.0337732 0.0389696 -0.048721 0.0342264 -0.0389696 -0.048721 0.0342264 0.0529358 -0.0478391 0.030638 -0.0529358 -0.0478391 0.030638 0 0.012601 0.015873 0.0114012 0.012601 0.015873 -0.0114012 0.012601 0.015873 0.0216046 0.0142981 0.0147398 -0.0216046 0.0142981 0.0147398 0.0290115 0.0174409 0.0126413 -0.0290115 0.0174409 0.0126413 0.0312412 0.0192564 0.0114116 -0.0312412 0.0192564 0.0114116 0 0.0192564 0.015873 0.0114012 0.0192564 0.015873 -0.0114012 0.0192564 0.015873 0.0216046 0.0192564 0.0147398 -0.0216046 0.0192564 0.0147398 0.0290115 0.0192564 0.0126413 -0.0290115 0.0192564 0.0126413 0 0.0192564 0.0114116 ] } coordIndex [ 16 7 6 -1 6 7 17 -1 30 5 2 -1 3 5 31 -1 30 6 5 -1 5 6 31 -1 6 30 16 -1 17 31 6 -1 57 61 59 -1 60 62 58 -1 42 44 68 -1 69 45 43 -1 70 54 55 -1 55 54 71 -1 48 54 70 -1 71 54 49 -1 70 55 50 -1 51 55 71 -1 40 42 68 -1 69 43 41 -1 46 44 78 -1 78 45 47 -1 16 95 18 -1 19 96 17 -1 16 30 95 -1 96 31 17 -1 52 105 107 -1 108 106 53 -1 87 89 79 -1 80 90 88 -1 93 109 91 -1 92 110 94 -1 83 109 93 -1 94 110 84 -1 83 93 85 -1 86 94 84 -1 28 105 52 -1 53 106 29 -1 72 46 76 -1 77 47 73 -1 72 76 74 -1 75 77 73 -1 48 70 76 -1 77 71 49 -1 48 76 46 -1 47 77 49 -1 97 119 111 -1 112 120 98 -1 125 81 79 -1 80 82 126 -1 109 125 91 -1 92 126 110 -1 79 89 125 -1 126 90 80 -1 89 91 125 -1 126 92 90 -1 121 119 81 -1 82 120 122 -1 123 121 81 -1 82 122 124 -1 125 123 81 -1 82 124 126 -1 111 113 115 -1 116 114 112 -1 115 101 99 -1 100 102 116 -1 99 97 111 -1 112 98 100 -1 99 111 115 -1 116 112 100 -1 115 117 107 -1 108 118 116 -1 115 107 105 -1 106 108 116 -1 103 101 115 -1 116 102 104 -1 103 115 105 -1 106 116 104 -1 125 109 107 -1 108 110 126 -1 125 107 117 -1 118 108 126 -1 95 81 119 -1 120 82 96 -1 95 119 97 -1 98 120 96 -1 115 123 117 -1 118 124 116 -1 123 125 117 -1 118 126 124 -1 113 121 115 -1 116 122 114 -1 121 123 115 -1 116 124 122 -1 111 119 113 -1 114 120 112 -1 119 121 113 -1 114 122 120 -1 50 109 83 -1 84 110 51 -1 44 46 87 -1 88 47 45 -1 44 87 79 -1 80 88 45 -1 76 70 85 -1 86 71 77 -1 76 85 93 -1 94 86 77 -1 74 76 93 -1 94 77 75 -1 74 93 91 -1 92 94 75 -1 72 74 91 -1 92 75 73 -1 72 91 89 -1 90 92 73 -1 46 72 89 -1 90 73 47 -1 46 89 87 -1 88 90 47 -1 50 85 70 -1 71 86 51 -1 50 83 85 -1 86 84 51 -1 68 44 79 -1 80 45 69 -1 68 79 81 -1 82 80 69 -1 46 78 54 -1 54 78 47 -1 46 54 48 -1 49 54 47 -1 42 66 44 -1 45 66 43 -1 66 78 44 -1 45 78 66 -1 57 40 67 -1 67 41 58 -1 57 67 65 -1 65 67 58 -1 59 66 42 -1 43 66 60 -1 59 64 66 -1 66 64 60 -1 57 63 61 -1 62 63 58 -1 57 65 63 -1 63 65 58 -1 61 64 59 -1 60 64 62 -1 61 63 64 -1 64 63 62 -1 57 59 40 -1 41 60 58 -1 59 42 40 -1 41 43 60 -1 52 50 55 -1 55 51 53 -1 52 55 56 -1 56 55 53 -1 13 39 14 -1 15 39 13 -1 14 39 35 -1 36 39 15 -1 2 32 37 -1 38 33 3 -1 37 32 35 -1 36 33 38 -1 0 35 32 -1 33 36 1 -1 0 14 35 -1 36 15 1 -1 34 0 32 -1 33 1 34 -1 0 34 4 -1 4 34 1 -1 2 5 32 -1 33 5 3 -1 32 5 34 -1 34 5 33 -1 14 0 4 -1 4 1 15 -1 4 13 14 -1 15 13 4 -1 107 127 52 -1 53 128 108 -1 127 50 52 -1 53 51 128 -1 107 109 127 -1 128 110 108 -1 127 109 50 -1 51 110 128 -1 35 133 37 -1 38 134 36 -1 68 81 139 -1 140 82 69 -1 81 141 139 -1 140 142 82 -1 95 141 81 -1 82 142 96 -1 95 143 141 -1 142 144 96 -1 95 145 143 -1 144 146 96 -1 95 37 145 -1 146 38 96 -1 30 37 95 -1 96 38 31 -1 2 37 30 -1 31 38 3 -1 35 39 67 -1 67 39 36 -1 133 35 67 -1 67 36 134 -1 137 133 67 -1 67 134 138 -1 129 137 67 -1 67 138 130 -1 135 129 67 -1 67 130 136 -1 131 135 67 -1 67 136 132 -1 40 131 67 -1 67 132 41 -1 9 22 10 -1 10 23 9 -1 10 22 24 -1 25 23 10 -1 12 52 56 -1 56 53 12 -1 24 26 147 -1 148 27 25 -1 26 28 149 -1 150 29 27 -1 151 10 24 -1 25 10 152 -1 151 24 147 -1 148 25 152 -1 149 147 26 -1 27 148 150 -1 155 157 153 -1 154 157 156 -1 153 157 158 -1 158 157 154 -1 147 149 155 -1 156 150 148 -1 159 22 9 -1 9 23 160 -1 9 8 159 -1 160 8 9 -1 161 159 8 -1 8 160 162 -1 22 159 163 -1 164 160 23 -1 167 97 99 -1 100 98 168 -1 99 22 167 -1 168 23 100 -1 167 22 163 -1 164 23 168 -1 97 167 165 -1 166 168 98 -1 171 169 173 -1 174 170 172 -1 179 173 177 -1 178 174 180 -1 171 173 179 -1 180 174 172 -1 179 177 175 -1 176 178 180 -1 181 161 8 -1 8 162 182 -1 8 7 183 -1 184 7 8 -1 183 7 16 -1 17 7 184 -1 183 181 8 -1 8 182 184 -1 20 161 185 -1 186 162 21 -1 185 165 20 -1 21 166 186 -1 97 165 187 -1 188 166 98 -1 189 18 95 -1 96 19 190 -1 95 97 189 -1 190 98 96 -1 189 97 187 -1 188 98 190 -1 161 181 185 -1 186 182 162 -1 16 18 183 -1 184 19 17 -1 187 165 185 -1 186 166 188 -1 201 191 195 -1 196 192 202 -1 201 193 191 -1 192 194 202 -1 195 199 197 -1 198 200 196 -1 195 191 199 -1 200 192 196 -1 208 210 217 -1 218 211 209 -1 12 28 52 -1 53 29 12 -1 213 219 212 -1 212 219 214 -1 215 219 213 -1 214 219 216 -1 217 219 215 -1 216 219 218 -1 210 219 217 -1 218 219 211 -1 11 149 12 -1 12 150 11 -1 12 149 28 -1 29 150 12 -1 206 208 215 -1 216 209 207 -1 208 217 215 -1 216 218 209 -1 206 213 204 -1 205 214 207 -1 206 215 213 -1 214 216 207 -1 204 212 203 -1 203 212 205 -1 204 213 212 -1 212 214 205 -1 181 183 199 -1 200 184 182 -1 183 197 199 -1 200 198 184 -1 189 187 193 -1 194 188 190 -1 189 193 201 -1 202 194 190 -1 18 189 195 -1 196 190 19 -1 189 201 195 -1 196 202 190 -1 185 181 199 -1 200 182 186 -1 185 199 191 -1 192 200 186 -1 183 18 195 -1 196 19 184 -1 183 195 197 -1 198 196 184 -1 187 185 191 -1 192 186 188 -1 187 191 193 -1 194 192 188 -1 161 20 179 -1 180 21 162 -1 161 179 175 -1 176 180 162 -1 159 161 177 -1 178 162 160 -1 161 175 177 -1 178 176 162 -1 163 159 173 -1 174 160 164 -1 159 177 173 -1 174 178 160 -1 20 165 179 -1 180 166 21 -1 165 171 179 -1 180 172 166 -1 167 163 173 -1 174 164 168 -1 167 173 169 -1 170 174 168 -1 165 167 171 -1 172 168 166 -1 167 169 171 -1 172 170 168 -1 11 155 149 -1 150 156 11 -1 11 157 155 -1 156 157 11 -1 147 153 151 -1 152 154 148 -1 147 155 153 -1 154 156 148 -1 151 158 10 -1 10 158 152 -1 151 153 158 -1 158 154 152 -1 22 99 24 -1 25 100 23 -1 24 99 101 -1 102 100 25 -1 24 101 26 -1 27 102 25 -1 26 101 103 -1 104 102 27 -1 26 103 28 -1 29 104 27 -1 28 103 105 -1 106 104 29 -1 40 68 139 -1 140 69 41 -1 40 139 131 -1 132 140 41 -1 129 145 137 -1 138 146 130 -1 129 143 145 -1 146 144 130 -1 137 37 133 -1 134 38 138 -1 137 145 37 -1 38 146 138 -1 129 135 141 -1 142 136 130 -1 129 141 143 -1 144 142 130 -1 135 131 139 -1 140 132 136 -1 135 139 141 -1 142 140 136 -1 ] creaseAngle 0.2 } } ] } LED { rotation 0.5774 0.5773 0.5773 2.0944 %< if (has_jersey) { >% translation -0.056 -0.005 -0.01 %< } else { >% translation -0.076 -0.005 -0.01 %< } >% color [ 0 1 0 ] name "BackLedGreen" children [ Shape { appearance PBRAppearance { transparency 0.1 metalness 0 roughness 0.3 emissiveIntensity 6 } geometry Box { size 0.002 0.005 0.002 } } ] } LED { rotation 0.5774 0.5773 0.5773 2.0944 %< if (has_jersey) { >% translation -0.056 0 -0.01 %< } else { >% translation -0.076 0 -0.01 %< } >% color [ 0 0 1 ] name "BackLedBlue" children [ Shape { appearance PBRAppearance { transparency 0.1 metalness 0 roughness 0.3 emissiveIntensity 6 } geometry Box { size 0.002 0.005 0.002 } } ] } LED { rotation 0.5774 0.5773 0.5773 2.0944 %< if (has_jersey) { >% translation -0.056 0.005 -0.01 %< } else { >% translation -0.076 0.005 -0.01 %< } >% color [ 1 0 0 ] name "BackLedRed" children [ Shape { appearance PBRAppearance { metalness 0 roughness 0.2 } geometry Box { size 0.002 0.005 0.002 } } ] } Speaker { translation 0.2 0 0 rotation -0.9831 0.1294 -0.1294 -1.5878 name "Speaker" } Accelerometer { translation -0.01 0 -0.068 rotation 0 0 1.0 -1.5708 name "Accelerometer" lookupTable [ -39.24 0 0 39.24 1024 0 ] } Gyro { translation 0.01 0 -0.068 rotation 0 0 1.0 -3.1416 name "Gyro" lookupTable [ -27.925 0 0 27.925 1024 0 ] } DEF RECEIVER Receiver { rotation 0.5774 0.5773 0.5773 2.0944 name "receiver" channel IS channel } DEF EMITTER Emitter { rotation 0.5774 0.5773 0.5773 2.0944 name "emitter" channel IS channel } DEF SUPER_EMITTER Emitter { rotation 0.5774 0.5773 0.5773 2.0944 name "super_emitter" channel 2 } # Neck %< if (enable_backlash) { >% DEF DNeck HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_neck >% %< } else { >% DEF DNeck HingeJoint { %< } >% device [ RotationalMotor { name "Neck" acceleration 55 maxVelocity 12.26 minPosition -1.81 maxPosition 1.81 maxTorque 2.5 } PositionSensor { name "NeckS" } ] jointParameters HingeJointParameters { axis 0 0 1 anchor 0.0 -0.0 0.051 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 0 0.051 rotation 0.5774 0.5773 0.5773 2.0944 children [ DEF DNeckShape Shape { appearance DEF METAL_APPEARANCE PBRAppearance { baseColor 0.7 0.7 0.7 roughness 0.2 } geometry IndexedFaceSet { coord Coordinate { point [ 0.0208742 0.0089758 0.0084754 0.0208741 0.0005642 0.0119739 0.0208742 -0.0079164 0.0084754 0.0208744 -0.0114149 2.93e-05 0.0208747 -0.0079164 -0.0084168 0.0208748 0.0005642 -0.0119153 0.0208747 0.0089758 -0.0084168 0.0208744 0.0124743 2.93e-05 0.0190454 0.0089758 0.0084754 0.0190453 0.0005642 0.0119739 0.0190454 -0.0079164 0.0084754 0.0190457 -0.0114149 2.93e-05 0.019046 -0.0079164 -0.0084169 0.0190461 0.0005642 -0.0119153 0.019046 0.0089758 -0.0084168 0.0190457 0.0124743 2.93e-05 0.0221934 -0.0308684 -0.0108051 0.0221927 -0.0308684 0.011001 0.0208741 -0.0294766 0.011001 0.0208748 -0.0294766 -0.0108052 0.0208748 0.0005642 -0.0108052 0.0208741 0.0005642 0.011001 0.0221927 0.0005642 0.011001 0.0221934 0.0005642 -0.0108051 -0.0087984 -0.0327532 2.38e-05 -0.0062282 -0.0327532 -0.0061801 -2.38e-05 -0.0327532 -0.0087497 0.0061804 -0.0327532 -0.0061797 0.0087501 -0.0327532 2.44e-05 0.00618 -0.0327532 0.0062283 -2.44e-05 -0.0327532 0.0087979 -0.0062287 -0.0327532 0.0062279 -0.0087984 -0.0308684 2.38e-05 -0.0062282 -0.0308684 -0.0061801 -2.38e-05 -0.0308684 -0.0087497 0.0061804 -0.0308684 -0.0061797 0.0087501 -0.0308684 2.44e-05 0.00618 -0.0308684 0.0062283 -2.44e-05 -0.0308684 0.0087979 -0.0062287 -0.0308684 0.0062279 0.0225672 0.0047428 2.94e-05 0.0225673 0.0035099 -0.002947 0.0225674 0.0005528 -0.0041799 0.0225673 -0.0024429 -0.002947 0.0225672 -0.0036757 2.94e-05 0.0225671 -0.0024429 0.0030058 0.0225671 0.0005528 0.0042386 0.0225671 0.0035099 0.0030058 -0.0225672 0.0035099 0.003005 -0.0225672 0.0005528 0.0042379 -0.0225672 -0.0024429 0.003005 -0.0225672 -0.0036757 2.86e-05 -0.0225672 -0.0024429 -0.0029478 -0.0225672 0.0005528 -0.0041806 -0.0225672 0.0035099 -0.0029478 -0.0225672 0.0047428 2.86e-05 -0.0190457 0.0124743 2.86e-05 -0.0190457 0.0089758 -0.0084175 -0.0190457 0.0005642 -0.011916 -0.0190457 -0.0079164 -0.0084175 -0.0190457 -0.0114149 2.86e-05 -0.0190457 -0.0079164 0.0084747 -0.0190457 0.0005642 0.0119732 -0.0190457 0.0089758 0.0084747 -0.0208745 0.0124743 2.86e-05 -0.0208744 0.0089758 -0.0084175 -0.0208744 0.0005642 -0.011916 -0.0208744 -0.0079164 -0.0084175 -0.0208745 -0.0114149 2.86e-05 -0.0208745 -0.0079164 0.0084747 -0.0208745 0.0005642 0.0119732 -0.0208745 0.0089758 0.0084747 -0.022193 0.0005642 -0.0108059 -0.022193 0.0005642 0.0110002 -0.0208745 0.0005642 0.0110002 -0.0208744 0.0005642 -0.0108059 -0.0208744 -0.0294766 -0.0108059 -0.0208745 -0.0294766 0.0110002 -0.022193 -0.0308684 0.0110002 -0.022193 -0.0308684 -0.0108059 ] } coordIndex [ 2 3 4 -1 1 2 4 -1 1 4 5 -1 0 1 5 -1 0 5 6 -1 0 6 7 -1 10 12 11 -1 10 13 12 -1 9 13 10 -1 8 13 9 -1 8 14 13 -1 15 14 8 -1 24 25 31 -1 31 25 26 -1 31 26 30 -1 30 26 29 -1 29 26 27 -1 29 27 28 -1 41 40 47 -1 41 47 42 -1 42 47 46 -1 42 46 45 -1 42 45 43 -1 43 45 44 -1 39 31 30 -1 39 30 38 -1 38 30 29 -1 38 29 37 -1 37 29 28 -1 37 28 36 -1 36 28 27 -1 36 27 35 -1 35 27 26 -1 35 26 34 -1 34 26 25 -1 34 25 33 -1 33 25 24 -1 33 24 32 -1 31 39 32 -1 31 32 24 -1 19 21 20 -1 19 18 21 -1 23 21 22 -1 23 20 21 -1 16 22 17 -1 16 23 22 -1 17 22 18 -1 18 22 21 -1 19 23 16 -1 19 20 23 -1 8 0 7 -1 8 7 15 -1 6 14 15 -1 6 15 7 -1 5 13 14 -1 5 14 6 -1 4 12 13 -1 4 13 5 -1 3 11 12 -1 3 12 4 -1 2 10 11 -1 2 11 3 -1 1 9 10 -1 1 10 2 -1 0 8 9 -1 0 9 1 -1 71 70 62 -1 71 62 63 -1 70 69 61 -1 70 61 62 -1 69 68 60 -1 69 60 61 -1 68 67 59 -1 68 59 60 -1 67 66 58 -1 67 58 59 -1 66 65 57 -1 66 57 58 -1 65 64 56 -1 65 56 57 -1 63 56 64 -1 63 64 71 -1 52 51 50 -1 53 52 50 -1 53 50 49 -1 53 49 48 -1 54 53 48 -1 54 48 55 -1 56 63 57 -1 63 58 57 -1 63 62 58 -1 62 61 58 -1 61 59 58 -1 61 60 59 -1 71 64 65 -1 71 65 66 -1 71 66 70 -1 70 66 67 -1 70 67 69 -1 69 67 68 -1 76 72 75 -1 76 79 72 -1 77 74 73 -1 78 77 73 -1 79 73 72 -1 79 78 73 -1 72 74 75 -1 72 73 74 -1 76 74 77 -1 76 75 74 -1 40 41 54 -1 40 54 55 -1 41 42 53 -1 41 53 54 -1 42 43 52 -1 42 52 53 -1 43 44 51 -1 43 51 52 -1 44 45 50 -1 44 50 51 -1 45 46 49 -1 45 49 50 -1 46 47 48 -1 46 48 49 -1 40 55 48 -1 40 48 47 -1 17 18 77 -1 17 77 78 -1 18 19 76 -1 18 76 77 -1 16 17 78 -1 16 78 79 -1 16 79 76 -1 16 76 19 -1 ] creaseAngle 0.2 } } # Head %< if (enable_backlash) { >% DEF DHead HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_head >% %< } else { >% DEF DHead HingeJoint { %< } >% device [ RotationalMotor { name "Head" acceleration 55 maxVelocity 12.26 minPosition -0.36 maxPosition 0.94 maxTorque 2.5 } PositionSensor { name "HeadS" } ] jointParameters HingeJointParameters { axis -1 0 0 position 0.19 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { rotation -1 0 0 -0.5954 children [ DEF HEAD_SLOT Pose { translation 0 0.022 -0.012 children IS headSlot } DEF DHeadShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DHeadCoord Coordinate { point [ 0.0392305 0.0221018 -0.0570645 -0.0392305 0.0221018 -0.0570645 0.0405922 0.0152099 -0.0401748 -0.0405922 0.0152099 -0.0401748 0.0411355 0.0081425 -0.0334363 -0.0411355 0.0081425 -0.0334363 0.0416294 -0.0007687 -0.0273103 -0.0416294 -0.0007687 -0.0273103 0.0424073 -0.0072215 -0.0176621 -0.0424073 -0.0072215 -0.0176621 0.0433401 -0.0086732 -0.0060919 -0.0433401 -0.0086732 -0.0060919 0.044197 -0.0061456 0.0045363 -0.044197 -0.0061456 0.0045363 0.0449545 0.0006532 0.0139317 -0.0449545 0.0006532 0.0139317 0.0452514 0.0108622 0.0176143 -0.0452514 0.0108622 0.0176143 0.0452514 0.0212564 0.0176141 -0.0452514 0.0212564 0.0176141 0.0449057 0.0300627 0.0137528 -0.0449057 0.0300627 0.0137528 0.0442507 0.0353979 0.0052024 -0.0442507 0.0353979 0.0052024 0.0433849 0.0381032 -0.0055372 -0.0433849 0.0381032 -0.0055372 0.038476 0.0363362 -0.0664233 -0.038476 0.0363362 -0.0664233 0.0116412 0.0265999 0.0366955 -0.0116412 0.0265999 0.0366955 0.0152554 0.0218632 0.0363648 -0.0152554 0.0218632 0.0363648 0.0201309 0.0187384 0.0349243 -0.0201309 0.0187384 0.0349243 0.0255253 0.0177015 0.0325931 -0.0255253 0.0177015 0.0325931 0.0306174 0.0189101 0.0297263 -0.0306174 0.0189101 0.0297263 0.034632 0.0221804 0.0267603 -0.034632 0.0221804 0.0267603 0.0369579 0.0270145 0.0241466 -0.0369579 0.0270145 0.0241466 0.037241 0.0326763 0.0222832 -0.037241 0.0326763 0.0222832 0.0354382 0.038304 0.0214537 -0.0354382 0.038304 0.0214537 0.0318239 0.0430408 0.0217844 -0.0318239 0.0430408 0.0217844 0.0269485 0.0461655 0.023225 -0.0269485 0.0461655 0.023225 0.0215541 0.0472024 0.0255561 -0.0215541 0.0472024 0.0255561 0.016462 0.0459938 0.0284229 -0.016462 0.0459938 0.0284229 0.0124474 0.0427235 0.0313889 -0.0124474 0.0427235 0.0313889 0.0101215 0.0378894 0.0340026 -0.0101215 0.0378894 0.0340026 0.0098384 0.0322276 0.035866 -0.0098384 0.0322276 0.035866 0.0174415 0.0294527 0.0329804 -0.0174415 0.0294527 0.0329804 0.0192939 0.0270251 0.032811 -0.0192939 0.0270251 0.032811 0.0217926 0.0254236 0.0320726 -0.0217926 0.0254236 0.0320726 0.0245573 0.0248921 0.0308779 -0.0245573 0.0248921 0.0308779 0.0271671 0.0255116 0.0294086 -0.0271671 0.0255116 0.0294086 0.0292247 0.0271877 0.0278885 -0.0292247 0.0271877 0.0278885 0.0304167 0.0296652 0.026549 -0.0304167 0.0296652 0.026549 0.0305618 0.0325669 0.0255939 -0.0305618 0.0325669 0.0255939 0.0296378 0.0354512 0.0251688 -0.0296378 0.0354512 0.0251688 0.0277855 0.0378789 0.0253383 -0.0277855 0.0378789 0.0253383 0.0252868 0.0394803 0.0260766 -0.0252868 0.0394803 0.0260766 0.022522 0.0400118 0.0272713 -0.022522 0.0400118 0.0272713 0.0199123 0.0393923 0.0287406 -0.0199123 0.0393923 0.0287406 0.0178547 0.0377163 0.0302607 -0.0178547 0.0377163 0.0302607 0.0166627 0.0352387 0.0316003 -0.0166627 0.0352387 0.0316003 0.0165176 0.032337 0.0325553 -0.0165176 0.032337 0.0325553 0.0235397 0.032452 0.0290746 -0.0235397 0.032452 0.0290746 0.0195178 0.0464315 -0.0795508 -0.0195178 0.0464315 -0.0795508 0.0225675 0.0325759 -0.07354 -0.0225675 0.0325759 -0.07354 0.0195174 0.016289 -0.0574006 -0.0195174 0.016289 -0.0574006 0.0186086 0.0055227 -0.0552789 -0.0186086 0.0055227 -0.0552789 0.0184255 -0.0009917 -0.051584 -0.0184255 -0.0009917 -0.051584 0.0186973 -0.0121609 -0.0394498 -0.0186973 -0.0121609 -0.0394498 0.0207908 -0.0194756 -0.0266185 -0.0207908 -0.0194756 -0.0266185 0.0185759 -0.0211818 -0.014516 -0.0185759 -0.0211818 -0.014516 0.0186379 -0.0196935 -0.001655 -0.0186379 -0.0196935 -0.001655 0.0187539 -0.0135358 0.0128219 -0.0187539 -0.0135358 0.0128219 0.018584 -0.0050813 0.024037 -0.018584 -0.0050813 0.024037 0.0164893 0.0066883 0.0349741 -0.0164893 0.0066883 0.0349741 0.0165623 0.0155422 0.0362219 -0.0165623 0.0155422 0.0362219 0.0170276 0.0499737 0.0249869 -0.0170276 0.0499737 0.0249869 0.01726 0.0553882 0.0150497 -0.01726 0.0553882 0.0150497 0.0120454 0.0605195 0.0046781 -0.0120454 0.0605195 0.0046781 0.0181589 0.0602533 -0.0062721 -0.0181589 0.0602533 -0.0062721 0.0195168 0.060201 -0.0189165 -0.0195168 0.060201 -0.0189165 0.0195174 0.0540533 -0.0540891 -0.0195174 0.0540533 -0.0540891 0 -0.0138808 -0.0402319 0 -0.0213466 -0.0278119 0 -0.0227678 -0.0144287 0 -0.022019 -1.81e-05 0 -0.0156556 0.0154359 0 -0.0061624 0.0265574 0 0.0074755 0.0378864 0 0.0175306 0.0379284 0 0.032467 0.0361502 0 0.0381629 0.0344413 0 0.045242 0.0309423 0 0.0488546 0.0285779 0 0.057406 0.0180599 0 0.0609716 0.0107532 0 0.060921 -0.0062633 0 0.0608675 -0.0189168 0 0.051912 -0.0393596 0 0.0386829 -0.0524273 0.0195171 0.0508041 -0.0384949 -0.0195171 0.0508041 -0.0384949 0.0195173 0.0380376 -0.0514338 -0.0195173 0.0380376 -0.0514338 0 0.0161334 -0.0593111 0 0.004431 -0.0571641 0 -0.0022158 -0.0534247 0.0291343 0.0417313 -0.0729934 -0.0291343 0.0417313 -0.0729934 0.0304317 0.0350942 -0.0702807 -0.0304317 0.0350942 -0.0702807 0.0297588 0.0190742 -0.0580713 -0.0297588 0.0190742 -0.0580713 0.031687 0.0160369 -0.0526305 -0.031687 0.0160369 -0.0526305 0.0309837 0.0092284 -0.0486846 -0.0309837 0.0092284 -0.0486846 0.030947 0.0028528 -0.0442747 -0.030947 0.0028528 -0.0442747 0.0313671 -0.0070052 -0.0342981 -0.0313671 -0.0070052 -0.0342981 0.0327293 -0.0142829 -0.0243646 -0.0327293 -0.0142829 -0.0243646 0.0320906 -0.0174994 -0.0152496 -0.0320906 -0.0174994 -0.0152496 0.0334606 -0.0171215 -0.0025047 -0.0334606 -0.0171215 -0.0025047 0.0348758 -0.0119176 0.010511 -0.0348758 -0.0119176 0.010511 0.0352073 -0.0039472 0.0212155 -0.0352073 -0.0039472 0.0212155 0.0303691 0.0014046 0.0276174 -0.0303691 0.0014046 0.0276174 0.0331355 0.0159014 0.0280857 -0.0331355 0.0159014 0.0280857 0.033055 0.0441668 0.018925 -0.033055 0.0441668 0.018925 0.0272452 0.0520301 0.0117203 -0.0272452 0.0520301 0.0117203 0.0274988 0.054967 0.0026082 -0.0274988 0.054967 0.0026082 0.0273044 0.0556295 -0.0065691 -0.0273044 0.0556295 -0.0065691 0.0276693 0.0543365 -0.0244786 -0.0276693 0.0543365 -0.0244786 0.0323266 0.0444186 -0.0491837 -0.0323266 0.0444186 -0.0491837 0.0417486 0.0375142 -0.0258325 -0.0417486 0.0375142 -0.0258325 0.0401123 0.0369252 -0.0461279 -0.0401123 0.0369252 -0.0461279 0.0070464 0.0573781 0.01728 -0.0070464 0.0573781 0.01728 0.0083894 0.0559858 0.019199 -0.0083894 0.0559858 0.019199 0.008978 0.0540208 0.0218855 -0.008978 0.0540208 0.0218855 0.0049843 0.051013 0.0258813 -0.0049843 0.051013 0.0258813 0.0381348 0.039614 0.0149968 -0.0381348 0.039614 0.0149968 0.0374798 0.0437726 0.0079673 -0.0374798 0.0437726 0.0079673 0.0368872 0.0477009 -0.0022339 -0.0368872 0.0477009 -0.0022339 0.0349777 0.0463099 -0.0278206 -0.0349777 0.0463099 -0.0278206 0 0.0572104 -0.0285718 0 0.0462024 -0.0462686 0.0195172 0.0456088 -0.0455197 -0.0195172 0.0456088 -0.0455197 0.0195174 0.0280225 -0.056562 -0.0195174 0.0280225 -0.056562 0 0.0286387 -0.0571265 0.0195169 0.0566908 -0.0283183 -0.0195169 0.0566908 -0.0283183 ] } coordIndex [ 18 16 14 -1 15 17 19 -1 20 18 14 -1 15 19 21 -1 20 14 12 -1 13 15 21 -1 22 20 12 -1 13 21 23 -1 24 22 12 -1 13 23 25 -1 24 12 10 -1 11 13 25 -1 197 24 10 -1 11 25 198 -1 197 10 8 -1 9 11 198 -1 197 8 6 -1 7 9 198 -1 199 197 6 -1 7 198 200 -1 199 6 4 -1 5 7 200 -1 199 4 2 -1 3 5 200 -1 187 48 185 -1 186 49 188 -1 122 48 187 -1 188 49 123 -1 124 122 187 -1 188 123 125 -1 124 187 189 -1 190 188 125 -1 126 124 189 -1 190 125 127 -1 126 189 191 -1 192 190 127 -1 126 191 193 -1 194 192 127 -1 128 126 193 -1 194 127 129 -1 130 128 193 -1 194 129 131 -1 130 193 195 -1 196 194 131 -1 116 138 137 -1 137 138 117 -1 34 118 116 -1 117 119 35 -1 114 116 137 -1 137 117 115 -1 181 116 114 -1 115 117 182 -1 34 116 181 -1 182 117 35 -1 183 34 181 -1 182 35 184 -1 179 181 114 -1 115 182 180 -1 16 181 179 -1 180 182 17 -1 114 137 136 -1 136 137 115 -1 112 114 136 -1 136 115 113 -1 179 114 112 -1 113 115 180 -1 177 179 112 -1 113 180 178 -1 14 179 177 -1 178 180 15 -1 16 179 14 -1 15 180 17 -1 112 136 135 -1 135 136 113 -1 110 112 135 -1 135 113 111 -1 177 112 110 -1 111 113 178 -1 12 14 177 -1 178 15 13 -1 175 177 110 -1 111 178 176 -1 12 177 175 -1 176 178 13 -1 10 12 175 -1 176 13 11 -1 110 135 134 -1 134 135 111 -1 108 110 134 -1 134 111 109 -1 175 110 108 -1 109 111 176 -1 173 175 108 -1 109 176 174 -1 10 175 173 -1 174 176 11 -1 8 10 173 -1 174 11 9 -1 108 134 133 -1 133 134 109 -1 106 108 133 -1 133 109 107 -1 173 108 106 -1 107 109 174 -1 171 173 106 -1 107 174 172 -1 8 173 171 -1 172 174 9 -1 6 8 171 -1 172 9 7 -1 169 171 106 -1 107 172 170 -1 6 171 169 -1 170 172 7 -1 104 106 133 -1 133 107 105 -1 169 106 104 -1 105 107 170 -1 4 6 169 -1 170 7 5 -1 104 133 132 -1 132 133 105 -1 167 4 169 -1 170 5 168 -1 167 169 104 -1 105 170 168 -1 102 104 132 -1 132 105 103 -1 167 104 102 -1 103 105 168 -1 102 132 156 -1 156 132 103 -1 165 167 102 -1 103 168 166 -1 100 165 102 -1 103 166 101 -1 118 30 139 -1 139 31 119 -1 32 30 118 -1 119 31 33 -1 118 139 138 -1 138 139 119 -1 116 118 138 -1 138 119 117 -1 32 118 34 -1 35 119 33 -1 34 183 36 -1 37 184 35 -1 36 183 38 -1 39 184 37 -1 18 38 183 -1 184 39 19 -1 18 40 38 -1 39 41 19 -1 44 185 46 -1 47 186 45 -1 46 185 48 -1 49 186 47 -1 28 139 30 -1 31 139 29 -1 140 139 28 -1 29 139 140 -1 140 28 58 -1 59 29 140 -1 141 140 58 -1 59 140 141 -1 141 58 56 -1 57 59 141 -1 142 141 56 -1 57 141 142 -1 142 56 54 -1 55 57 142 -1 143 54 52 -1 53 55 143 -1 142 54 143 -1 143 55 142 -1 52 120 143 -1 143 121 53 -1 50 120 52 -1 53 121 51 -1 48 122 120 -1 121 123 49 -1 50 48 120 -1 121 49 51 -1 122 205 120 -1 121 206 123 -1 122 203 205 -1 206 204 123 -1 122 201 203 -1 204 202 123 -1 124 146 145 -1 145 146 125 -1 126 146 124 -1 125 146 127 -1 128 146 126 -1 127 146 129 -1 128 147 146 -1 146 147 129 -1 201 145 144 -1 144 145 202 -1 122 145 201 -1 202 145 123 -1 124 145 122 -1 123 145 125 -1 100 154 98 -1 99 154 101 -1 100 155 154 -1 154 155 101 -1 102 155 100 -1 101 155 103 -1 102 156 155 -1 155 156 103 -1 163 2 165 -1 166 3 164 -1 0 2 163 -1 164 3 1 -1 195 199 26 -1 27 200 196 -1 157 195 26 -1 27 196 158 -1 130 195 157 -1 158 196 131 -1 161 163 98 -1 99 164 162 -1 0 163 161 -1 162 164 1 -1 94 130 157 -1 158 131 95 -1 161 98 96 -1 97 99 162 -1 26 0 161 -1 162 1 27 -1 159 161 96 -1 97 162 160 -1 26 161 159 -1 160 162 27 -1 157 26 159 -1 160 27 158 -1 157 159 96 -1 97 160 158 -1 94 157 96 -1 97 158 95 -1 2 4 167 -1 168 5 3 -1 165 2 167 -1 168 3 166 -1 94 96 98 -1 99 97 95 -1 0 26 199 -1 200 27 1 -1 0 199 2 -1 3 200 1 -1 120 205 207 -1 208 206 121 -1 120 207 143 -1 143 208 121 -1 16 18 183 -1 184 19 17 -1 16 183 181 -1 182 184 17 -1 44 209 185 -1 186 210 45 -1 189 213 191 -1 192 214 190 -1 193 215 195 -1 196 216 194 -1 130 224 128 -1 129 225 131 -1 130 150 224 -1 225 151 131 -1 130 219 150 -1 151 220 131 -1 130 152 219 -1 220 153 131 -1 94 98 221 -1 222 99 95 -1 152 94 221 -1 222 95 153 -1 152 130 94 -1 95 131 153 -1 221 98 154 -1 154 99 222 -1 221 154 223 -1 223 154 222 -1 152 221 223 -1 223 222 153 -1 152 223 149 -1 149 223 153 -1 219 152 218 -1 218 153 220 -1 152 149 218 -1 218 149 153 -1 150 219 148 -1 148 220 151 -1 219 218 148 -1 148 218 220 -1 224 150 217 -1 217 151 225 -1 150 148 217 -1 217 148 151 -1 128 224 217 -1 217 225 129 -1 128 217 147 -1 147 217 129 -1 197 199 215 -1 216 200 198 -1 199 195 215 -1 216 196 200 -1 191 213 215 -1 216 214 192 -1 191 215 193 -1 194 216 192 -1 187 211 189 -1 190 212 188 -1 211 213 189 -1 190 214 212 -1 185 209 211 -1 212 210 186 -1 185 211 187 -1 188 212 186 -1 20 209 42 -1 43 210 21 -1 209 44 42 -1 43 45 210 -1 18 20 40 -1 41 21 19 -1 20 42 40 -1 41 43 21 -1 24 197 215 -1 216 198 25 -1 24 215 213 -1 214 216 25 -1 22 24 211 -1 212 25 23 -1 24 213 211 -1 212 214 25 -1 20 22 209 -1 210 23 21 -1 22 211 209 -1 210 212 23 -1 98 163 165 -1 166 164 99 -1 98 165 100 -1 101 166 99 -1 ] creaseAngle 0.52 } } Shape { appearance DEF PUPIL_APPEARANCE PBRAppearance { baseColor 0.05 0.05 0.05 metalness 0 roughness 0 } geometry IndexedFaceSet { coord USE DHeadCoord coordIndex [ 62 92 60 -1 61 93 63 -1 64 92 62 -1 63 93 65 -1 66 92 64 -1 65 93 67 -1 68 92 66 -1 67 93 69 -1 70 92 68 -1 69 93 71 -1 72 92 70 -1 71 93 73 -1 74 92 72 -1 73 93 75 -1 76 92 74 -1 75 93 77 -1 78 92 76 -1 77 93 79 -1 80 92 78 -1 79 93 81 -1 82 92 80 -1 81 93 83 -1 84 92 82 -1 83 93 85 -1 86 92 84 -1 85 93 87 -1 88 92 86 -1 87 93 89 -1 90 92 88 -1 89 93 91 -1 60 92 90 -1 91 93 61 -1 ] creaseAngle 0.52 } } ] } Camera { translation 0 0.0329074 0.0359816 rotation 0.577351 0.577352 0.577348 -2.094396 children [ DEF DCameraShape Shape { appearance DEF DCameraAppearance PBRAppearance { metalness 0 roughness 0.3 } geometry IndexedFaceSet { coord Coordinate { point [ 0.0016242 -0.0012902 0.0006454 0.0009796 -0.0012902 -0.0018532 0.0009796 0.0012902 -0.0018532 0.0016242 0.0012902 0.0006454 -0.0001212 -0.0030927 0.0010956 -0.0007657 -0.0030927 -0.001403 -0.001216 -0.0012902 -0.0031483 -0.001216 0.0012901 -0.0031484 -0.0007657 0.0030927 -0.001403 -0.0001212 0.0030927 0.0010956 0.0003291 -0.0012902 0.002841 0.0003291 0.0012902 0.002841 ] } coordIndex [ 0 10 4 -1 1 5 6 -1 2 7 8 -1 3 9 11 -1 9 3 2 -1 9 2 8 -1 10 0 3 -1 10 3 11 -1 7 2 1 -1 7 1 6 -1 0 4 5 -1 0 5 1 -1 0 1 2 -1 0 2 3 -1 ] creaseAngle 0.2 } } ] name "Camera" fieldOfView 1.0123 width IS cameraWidth height IS cameraHeight zoom Zoom { } } DEF DEyeLED LED { rotation 1 0 0 0 children [ DEF DEyeLEDShape Shape { appearance DEF DEyeLEDAppearance PBRAppearance { baseColor 0.7 0.7 0.7 metalness 0 roughness 0.3 emissiveIntensity 6 } geometry IndexedFaceSet { coord Coordinate { point [ 0.0116412 0.0265999 0.0366955 -0.0116412 0.0265999 0.0366955 0.0152554 0.0218632 0.0363648 -0.0152554 0.0218632 0.0363648 0.0201309 0.0187384 0.0349243 -0.0201309 0.0187384 0.0349243 0.0255253 0.0177015 0.0325931 -0.0255253 0.0177015 0.0325931 0.0306174 0.0189101 0.0297263 -0.0306174 0.0189101 0.0297263 0.034632 0.0221804 0.0267603 -0.034632 0.0221804 0.0267603 0.0369579 0.0270145 0.0241466 -0.0369579 0.0270145 0.0241466 0.037241 0.0326763 0.0222832 -0.037241 0.0326763 0.0222832 0.0354382 0.038304 0.0214537 -0.0354382 0.038304 0.0214537 0.0318239 0.0430408 0.0217844 -0.0318239 0.0430408 0.0217844 0.0269485 0.0461655 0.023225 -0.0269485 0.0461655 0.023225 0.0215541 0.0472024 0.0255561 -0.0215541 0.0472024 0.0255561 0.016462 0.0459938 0.0284229 -0.016462 0.0459938 0.0284229 0.0124474 0.0427235 0.0313889 -0.0124474 0.0427235 0.0313889 0.0101215 0.0378894 0.0340026 -0.0101215 0.0378894 0.0340026 0.0098384 0.0322276 0.035866 -0.0098384 0.0322276 0.035866 0.0174415 0.0294527 0.0329804 -0.0174415 0.0294527 0.0329804 0.0192939 0.0270251 0.032811 -0.0192939 0.0270251 0.032811 0.0217926 0.0254236 0.0320726 -0.0217926 0.0254236 0.0320726 0.0245573 0.0248921 0.0308779 -0.0245573 0.0248921 0.0308779 0.0271671 0.0255116 0.0294086 -0.0271671 0.0255116 0.0294086 0.0292247 0.0271877 0.0278885 -0.0292247 0.0271877 0.0278885 0.0304167 0.0296652 0.026549 -0.0304167 0.0296652 0.026549 0.0305618 0.0325669 0.0255939 -0.0305618 0.0325669 0.0255939 0.0296378 0.0354512 0.0251688 -0.0296378 0.0354512 0.0251688 0.0277855 0.0378789 0.0253383 -0.0277855 0.0378789 0.0253383 0.0252868 0.0394803 0.0260766 -0.0252868 0.0394803 0.0260766 0.022522 0.0400118 0.0272713 -0.022522 0.0400118 0.0272713 0.0199123 0.0393923 0.0287406 -0.0199123 0.0393923 0.0287406 0.0178547 0.0377163 0.0302607 -0.0178547 0.0377163 0.0302607 0.0166627 0.0352387 0.0316003 -0.0166627 0.0352387 0.0316003 0.0165176 0.032337 0.0325553 -0.0165176 0.032337 0.0325553 ] } coordIndex [ 0 32 62 -1 63 33 1 -1 0 62 30 -1 31 63 1 -1 0 2 34 -1 35 3 1 -1 0 34 32 -1 33 35 1 -1 2 4 36 -1 37 5 3 -1 2 36 34 -1 35 37 3 -1 6 8 40 -1 41 9 7 -1 6 40 38 -1 39 41 7 -1 8 10 42 -1 43 11 9 -1 8 42 40 -1 41 43 9 -1 10 12 44 -1 45 13 11 -1 10 44 42 -1 43 45 11 -1 14 16 48 -1 49 17 15 -1 14 48 46 -1 47 49 15 -1 16 18 50 -1 51 19 17 -1 16 50 48 -1 49 51 17 -1 18 20 52 -1 53 21 19 -1 18 52 50 -1 51 53 19 -1 22 24 56 -1 57 25 23 -1 22 56 54 -1 55 57 23 -1 24 26 58 -1 59 27 25 -1 24 58 56 -1 57 59 25 -1 26 28 60 -1 61 29 27 -1 26 60 58 -1 59 61 27 -1 28 30 62 -1 63 31 29 -1 28 62 60 -1 61 63 29 -1 4 6 38 -1 39 7 5 -1 4 38 36 -1 37 39 5 -1 12 14 46 -1 47 15 13 -1 12 46 44 -1 45 47 13 -1 20 22 54 -1 55 23 21 -1 20 54 52 -1 53 55 21 -1 ] creaseAngle 0.2 } } ] name "EyeLed" color [] gradual TRUE } DEF DHeadLED LED { rotation 1 0 0 0 children [ DEF DHeadLEDShape Shape { appearance DEF DHeadLEDAppearance PBRAppearance { baseColor 0.7 0.7 0.7 metalness 0 roughness 0.3 emissiveIntensity 6 } geometry IndexedFaceSet { coord Coordinate { point [ 0 0.0488546 0.0285779 0 0.057406 0.0180599 0.0070464 0.0573781 0.01728 -0.0070464 0.0573781 0.01728 0.0083894 0.0559858 0.019199 -0.0083894 0.0559858 0.019199 0.008978 0.0540208 0.0218855 -0.008978 0.0540208 0.0218855 0.0049843 0.051013 0.0258813 -0.0049843 0.051013 0.0258813 ] } coordIndex [ 0 8 1 -1 9 0 1 -1 1 8 6 -1 7 9 1 -1 1 6 4 -1 5 7 1 -1 1 4 2 -1 3 5 1 -1 ] creaseAngle 0.2 } } ] name "HeadLed" color [] gradual TRUE } ] boundingObject Pose { translation 0 0.022 -0.012 children [ Capsule { height 0.018 radius 0.042 } ] } physics Physics { density -1 mass 0.158042 centerOfMass [ 6.39198e-05 0.0185645 0.00766662 ] inertiaMatrix [ 1.2396830e-04 1.1783781e-04 1.1583601e-04 7.8494368e-07 -7.6459790e-08 1.2199205e-05 ] } } } ] name "neck" boundingObject Pose { translation 0 -0.009 0 children [ Box { size 0.044 0.043 0.022 } ] } physics Physics { density -1 mass 0.0243577 centerOfMass [ -0.00071 0.00142 -0.01657 ] inertiaMatrix [ 5.1411124e-06 8.1915737e-06 1.1379812e-05 -5.7530255e-07 -2.4729049e-08 -1.9223094e-07 ] } } } # PelvYL %< if (enable_backlash) { >% DEF DPelvYL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_pelv_y >% %< } else { >% DEF DPelvYL HingeJoint { %< } >% device [ RotationalMotor { name "PelvYL" acceleration 55 maxVelocity 12.26 minPosition -0.69 maxPosition 2.5 maxTorque 2.5 } PositionSensor { name "PelvYLS" } ] jointParameters HingeJointParameters { axis 0 0 -1 anchor -0.005 0.037 -0.1222 position -0.02 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation -0.005 0.037 -0.122 rotation 0.5697 0.5812 0.5812 2.106 children [ DEF DPelvYLShape Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord Coordinate { point [ 0.0084461 -0.0084461 0.0247278 0.0084461 0.0084461 0.0247278 -0 0.0119446 0.0247278 -0.0084461 0.0084461 0.0247278 -0.0119446 -3.45e-05 0.0247278 -0.0084461 -0.0084461 0.0247278 -0 -0.0119446 0.0247278 0.0084461 -0.0084461 0.022564 0.0119446 -3.45e-05 0.022564 0.0084461 0.0084461 0.022564 -0 0.0119446 0.022564 -0.0084461 0.0084461 0.022564 -0.0119446 -3.45e-05 0.022564 -0.0084461 -0.0084461 0.022564 0 -0.0119446 0.022564 0 -0.0119446 -0.0258612 -0.0084461 -0.0084461 -0.0258612 -0.0119446 -3.45e-05 -0.0258612 -0.0084461 0.0084461 -0.0258612 -0 0.0119446 -0.0258612 0.0084461 0.0084461 -0.0258612 0.0119446 -3.45e-05 -0.0258612 0.0084461 -0.0084461 -0.0258612 -0 -0.0119446 -0.0238143 -0.0084461 -0.0084461 -0.0238143 -0.0119446 -3.45e-05 -0.0238143 -0.0084461 0.0084461 -0.0238143 -0 0.0119446 -0.0238143 0.0084461 0.0084461 -0.0238143 0.0084461 -0.0084461 -0.0238143 -0.0108345 0.0313981 0.026288 -0.0108345 0.0313981 -0.0238143 0.0109716 0.0313981 0.026288 0.0109716 0.0313981 -0.0238143 0.0109716 0.0300063 -0.022288 0.0109716 0.0300063 0.0247278 -0.0108345 0.0300063 0.0247278 -0.0108345 0.0300063 -0.022288 -0.0108345 -3.45e-05 -0.022288 -0.0108345 -3.45e-05 0.0247278 0.0109716 -3.45e-05 0.0247278 0.0109716 -3.45e-05 -0.022288 0.0109716 -3.45e-05 -0.0238143 0.0109716 -3.45e-05 0.026288 -0.0108345 -3.45e-05 0.026288 -0.0108345 -3.45e-05 -0.0238143 0 0.0332829 -0.010382 -0.0073412 0.0332829 -0.0073412 -0.010382 0.0332829 -0 -0.0073412 0.0332829 0.0073412 -0 0.0332829 0.010382 0.0073412 0.0332829 0.0073412 0.010382 0.0332829 -0 0.0073412 0.0332829 -0.0073412 -0 0.0313981 -0.010382 -0.0073412 0.0313981 -0.0073412 -0.010382 0.0313981 -0 -0.0073412 0.0313981 0.0073412 -0 0.0313981 0.010382 0.0073412 0.0313981 0.0073412 0.010382 0.0313981 -0 0.0073412 0.0313981 -0.0073412 0.0029764 -0.0029802 -0.0263812 0.0042093 -2.31e-05 -0.0263812 0.0029764 0.0029726 -0.0263812 0 0.0042054 -0.0263812 -0.0029764 0.0029726 -0.0263812 -0.0042093 -2.31e-05 -0.0263812 -0.0029764 -0.0029802 -0.0263812 0 -0.0042131 -0.0263812 0 -0.0042131 0.0267308 -0.0029764 -0.0029802 0.0267308 -0.0042093 -2.31e-05 0.0267308 -0.0029764 0.0029726 0.0267308 0 0.0042054 0.0267308 0.0029764 0.0029726 0.0267308 0.0042093 -2.31e-05 0.0267308 0.0029764 -0.0029802 0.0267308 ] } coordIndex [ 1 2 3 -1 40 1 3 -1 40 3 4 -1 0 40 4 -1 0 4 5 -1 0 5 6 -1 9 11 10 -1 9 12 11 -1 8 12 9 -1 7 12 8 -1 7 13 12 -1 14 13 7 -1 46 47 53 -1 53 47 48 -1 53 48 52 -1 52 48 51 -1 51 48 49 -1 51 49 50 -1 28 27 26 -1 42 28 26 -1 42 26 25 -1 29 42 25 -1 29 25 24 -1 29 24 23 -1 20 18 19 -1 20 17 18 -1 21 17 20 -1 22 17 21 -1 22 16 17 -1 15 16 22 -1 69 68 62 -1 62 68 67 -1 62 67 63 -1 63 67 64 -1 64 67 66 -1 64 66 65 -1 71 70 77 -1 71 77 72 -1 72 77 76 -1 72 76 75 -1 72 75 73 -1 73 75 74 -1 63 77 62 -1 63 76 77 -1 64 76 63 -1 64 75 76 -1 65 75 64 -1 65 74 75 -1 66 74 65 -1 66 73 74 -1 67 73 66 -1 67 72 73 -1 68 72 67 -1 68 71 72 -1 69 71 68 -1 69 70 71 -1 62 70 69 -1 62 77 70 -1 61 53 52 -1 61 52 60 -1 60 52 51 -1 60 51 59 -1 59 51 50 -1 59 50 58 -1 58 50 49 -1 58 49 57 -1 57 49 48 -1 57 48 56 -1 56 48 47 -1 56 47 55 -1 55 47 46 -1 55 46 54 -1 53 61 54 -1 53 54 46 -1 38 34 37 -1 38 41 34 -1 36 40 39 -1 36 35 40 -1 34 36 37 -1 34 35 36 -1 42 38 45 -1 42 41 38 -1 44 40 43 -1 44 39 40 -1 33 45 31 -1 33 42 45 -1 30 43 32 -1 30 44 43 -1 34 42 33 -1 34 41 42 -1 32 43 35 -1 35 43 40 -1 36 44 30 -1 36 39 44 -1 31 45 37 -1 37 45 38 -1 30 31 36 -1 36 31 37 -1 33 35 34 -1 33 32 35 -1 30 33 31 -1 30 32 33 -1 29 22 21 -1 29 21 42 -1 42 21 20 -1 42 20 28 -1 28 20 19 -1 28 19 27 -1 27 19 18 -1 27 18 26 -1 26 18 17 -1 26 17 25 -1 25 17 16 -1 25 16 24 -1 24 16 15 -1 24 15 23 -1 23 15 22 -1 23 22 29 -1 7 0 6 -1 7 6 14 -1 5 13 14 -1 5 14 6 -1 4 12 13 -1 4 13 5 -1 3 11 12 -1 3 12 4 -1 2 10 11 -1 2 11 3 -1 1 9 10 -1 1 10 2 -1 40 8 9 -1 40 9 1 -1 0 7 8 -1 0 8 40 -1 ] creaseAngle 0.2 } } # PelvL %< if (enable_backlash) { >% DEF DPelvL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_pelv >% %< } else { >% DEF DPelvL HingeJoint { %< } >% device [ RotationalMotor { name "PelvL" acceleration 55 maxVelocity 12.26 minPosition -1 maxPosition 0.93 maxTorque 2.5 } PositionSensor { name "PelvLS" } ] jointParameters HingeJointParameters { axis 0 0 -1 position -0.01 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { rotation 0 0 -1 -0.01 children [ DEF DPelvLShape Shape { appearance DEF MOTOR_APPEARANCE PBRAppearance { baseColor 0 0 0 roughness 0.4 metalness 0 } geometry IndexedFaceSet { coord Coordinate { point [ 0.0180439 0.0115761 0.0214732 0.0180446 0.0115761 -0.0191624 -0.0175731 0.0115761 -0.0191624 -0.0175738 0.0115761 0.0214732 0.0180445 -0.0390897 -0.0141305 -0.0175731 -0.0390897 -0.0141305 -0.0175729 -0.0274952 -0.0268336 -0.0175723 -0.0274952 -0.0618489 0.0180453 -0.0274952 -0.0618482 0.0180447 -0.0274952 -0.026833 -0.0175729 0.0057494 -0.0268336 -0.0175723 0.0057494 -0.0618489 0.0180453 0.0057494 -0.0618482 0.0180447 0.0057494 -0.026833 0.0180439 -0.012828 0.0214732 -0.0175738 -0.012828 0.0214732 -0.0175737 -0.012828 0.0173256 0.0180439 -0.012828 0.0173256 0.0155869 -0.0390897 -0.0141304 -0.0151086 -0.0390897 -0.0141307 -0.0151077 -0.012828 0.0173255 0.0155877 -0.012828 0.0173258 -0.0151076 -0.012828 0.0113907 0.0155878 -0.012828 0.0113913 0.0155878 -0.0330725 0.0113913 -0.0151076 -0.0330725 0.0113907 -0.0151071 -0.0330725 -0.0190517 0.0155884 -0.0330725 -0.0190514 0.0180446 -0.0330725 -0.0190513 -0.0175731 -0.0330725 -0.0190518 0.0155877 -0.0330725 0.0173258 0.0180439 -0.0330725 0.0173256 -0.0175737 -0.0330725 0.0173256 -0.0151077 -0.0330725 0.0173255 0.018044 -0.0390897 0.0113913 0.0155876 -0.0390897 0.0113913 -0.0151079 -0.0390897 0.0113907 -0.0175736 -0.0390897 0.0113907 -0.0175729 -0.0274952 -0.0296594 -0.0175724 -0.0274952 -0.0590223 0.0180453 -0.0274952 -0.0590216 0.0180448 -0.0274952 -0.0296588 -0.0175729 0.0057494 -0.0296594 -0.0175724 0.0057494 -0.0590223 0.0180453 0.0057494 -0.0590216 0.0180448 0.0057494 -0.0296588 -0.0125429 -0.033322 -0.0590222 -0.0125435 -0.033322 -0.0296593 0.0128508 -0.033322 -0.0296589 0.0128513 -0.033322 -0.0590217 -0.0125429 0.0115761 -0.0590222 -0.0125435 0.0115761 -0.0296593 0.0128508 0.0115761 -0.0296589 0.0128513 0.0115761 -0.0590217 0.0128514 0.0115761 -0.0618483 0.0128508 0.0115761 -0.0268331 0.0128514 -0.033322 -0.0618483 0.0128508 -0.033322 -0.0268331 -0.0125429 0.0115761 -0.0618488 -0.0125429 -0.033322 -0.0618488 -0.0125435 -0.033322 -0.0268335 -0.0125435 0.0115761 -0.0268335 -0.0097554 -0.0094035 -0.0157652 -0.0097552 -0.0094035 -0.0307516 -0.0097552 -0.0153643 -0.0307516 -0.0097555 -0.0153643 -0.0157652 0.0100624 -0.0094034 -0.0157649 0.0100627 -0.0094034 -0.0307513 0.0100626 -0.0153642 -0.0307513 0.0100624 -0.0153642 -0.0157649 0.0100623 -0.0324485 -0.0157649 0.0100626 -0.0324485 -0.0307513 0.0100626 -0.0264878 -0.0307513 0.0100624 -0.0264878 -0.0157649 -0.0097555 -0.0324486 -0.0157652 -0.0097552 -0.0324486 -0.0307516 -0.0097552 -0.0264878 -0.0307516 -0.0097555 -0.0264878 -0.0157652 ] } coordIndex [ 0 14 1 -1 15 3 2 -1 1 14 17 -1 2 16 15 -1 16 20 15 -1 21 17 14 -1 22 33 25 -1 27 35 24 -1 5 26 19 -1 4 18 27 -1 4 27 28 -1 1 28 27 -1 1 17 28 -1 5 29 26 -1 2 26 29 -1 2 29 16 -1 33 36 25 -1 35 30 24 -1 33 22 20 -1 35 27 18 -1 31 28 17 -1 37 29 5 -1 75 74 77 -1 75 77 76 -1 73 70 71 -1 73 71 72 -1 77 73 72 -1 77 72 76 -1 75 71 70 -1 75 70 74 -1 64 68 69 -1 64 69 65 -1 62 66 67 -1 62 67 63 -1 66 69 68 -1 66 68 67 -1 64 65 62 -1 64 62 63 -1 46 47 51 -1 46 51 50 -1 56 46 59 -1 56 49 46 -1 46 48 47 -1 46 49 48 -1 47 48 57 -1 47 57 60 -1 55 51 61 -1 55 52 51 -1 54 58 50 -1 54 50 53 -1 50 52 53 -1 50 51 52 -1 38 42 51 -1 38 51 47 -1 6 38 47 -1 6 47 60 -1 6 60 61 -1 6 61 10 -1 10 61 51 -1 10 51 42 -1 11 43 50 -1 11 50 58 -1 39 46 50 -1 39 50 43 -1 7 11 58 -1 7 58 59 -1 7 59 46 -1 7 46 39 -1 9 57 48 -1 9 48 41 -1 9 13 55 -1 9 55 57 -1 13 45 52 -1 13 52 55 -1 8 40 49 -1 8 49 56 -1 12 54 53 -1 12 53 44 -1 8 54 12 -1 8 56 54 -1 40 44 53 -1 40 53 49 -1 55 60 57 -1 55 61 60 -1 56 58 54 -1 56 59 58 -1 48 53 52 -1 48 49 53 -1 40 8 12 -1 40 12 44 -1 9 41 45 -1 9 45 13 -1 38 6 10 -1 38 10 42 -1 7 39 43 -1 7 43 11 -1 36 33 32 -1 36 32 37 -1 30 35 34 -1 30 34 31 -1 29 37 16 -1 37 32 16 -1 28 31 34 -1 28 34 4 -1 1 27 26 -1 1 26 2 -1 26 25 19 -1 25 36 19 -1 24 25 26 -1 24 26 27 -1 23 24 30 -1 23 30 21 -1 23 22 25 -1 23 25 24 -1 14 15 20 -1 14 20 21 -1 20 22 23 -1 20 23 21 -1 36 37 5 -1 36 5 19 -1 34 35 18 -1 34 18 4 -1 32 33 20 -1 32 20 16 -1 30 31 17 -1 30 17 21 -1 14 0 3 -1 14 3 15 -1 0 1 2 -1 0 2 3 -1 41 48 52 45 -1 ] creaseAngle 0.2 } } # LegUpperL %< if (enable_backlash) { >% DEF DLegUpperL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_leg_upper >% %< } else { >% DEF DLegUpperL HingeJoint { %< } >% device [ RotationalMotor { name "LegUpperL" acceleration 55 maxVelocity 12.26 minPosition -0.5 maxPosition 1.68 maxTorque 2.5 } PositionSensor { name "LegUpperLS" } ] jointParameters HingeJointParameters { axis -1 0 0 position 1.15 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { rotation -1 0 0 1.15 children [ DEF DLegUpperLShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DLegUpperLCoord Coordinate { point [ 0.0148675 -0.0550762 0.0116404 0.0148666 -0.105434 0.0116412 0.014868 -0.0550767 -0.0137539 0.014867 -0.105435 -0.0137531 0.0104632 -0.105435 -0.0137532 0.0104628 -0.105434 0.0116411 0.0104642 -0.0550766 -0.013754 0.0104638 -0.0550761 0.0116403 0.0104634 -0.0995206 -0.0189472 0.0104628 -0.0995199 0.0166704 0.0104642 -0.0609908 -0.0189478 0.0104636 -0.0609902 0.0166698 0.0148672 -0.0995207 -0.0189471 0.0148666 -0.0995201 0.0166705 0.014868 -0.0609909 -0.0189477 0.0148673 -0.0609903 0.0166699 -0.0103675 -0.0609894 0.016669 -0.0103668 -0.0609901 -0.0189486 -0.0103682 -0.0995192 0.0166696 -0.0103676 -0.0995198 -0.018948 -0.0147712 -0.0609893 0.0166689 -0.0147706 -0.0609899 -0.0189487 -0.014772 -0.0995191 0.0166695 -0.0147714 -0.0995197 -0.0189481 -0.014771 -0.0550753 0.0116394 -0.0147706 -0.0550757 -0.0137548 -0.014772 -0.105433 0.0116402 -0.0147716 -0.105434 -0.0137541 -0.0103678 -0.105434 -0.013754 -0.0103668 -0.0550758 -0.0137548 -0.0103682 -0.105433 0.0116403 -0.0103673 -0.0550754 0.0116395 0.0182062 -0.105435 -0.013753 0.0182072 -0.0550767 -0.0137538 0.0182058 -0.105434 0.0116413 0.0182068 -0.0550763 0.0116405 -0.0177682 -0.105434 -0.0137541 -0.0177687 -0.105433 0.0116402 -0.0177672 -0.0550756 -0.0137549 -0.0177677 -0.0550752 0.0116394 0.0268712 -0.104905 -0.0082253 -0.0268712 -0.104905 -0.0082253 0.026871 -0.10766 -0.0007456 -0.026871 -0.10766 -0.0007456 0.0268709 -0.105566 0.0070039 -0.0268709 -0.105566 0.0070039 0.0247075 -0.100249 0.0112405 -0.0247075 -0.100249 0.0112405 0.0207275 -0.079843 0.0190445 -0.0207275 -0.079843 0.0190445 0.020718 -0.0748146 0.0190445 -0.020718 -0.0748146 0.0190445 0.0151308 -0.0748146 0.025602 -0.0151308 -0.0748146 0.025602 0.0151422 -0.0393893 0.025602 -0.0151422 -0.0393893 0.025602 0.0191712 -0.0383065 0.0220794 -0.0191712 -0.0383065 0.0220794 0.020085 -0.0355735 0.0202946 -0.020085 -0.0355735 0.0202946 0.0202365 -0.0210323 0.0199852 -0.0202365 -0.0210323 0.0199852 0.0247061 0.0037188 0.0112418 -0.0247061 0.0037188 0.0112418 0.0268709 0.0088188 0.0070039 -0.0268709 0.0088188 0.0070039 0.026871 0.011922 0.0021987 -0.026871 0.011922 0.0021987 0.0268711 0.0117651 -0.0047315 -0.0268711 0.0117651 -0.0047315 0.0268712 0.0086289 -0.0101251 -0.0268712 0.0086289 -0.0101251 0.0268712 0.0032575 -0.0132311 -0.0268712 0.0032575 -0.0132311 0.0268712 -0.0529296 -0.012096 -0.0268712 -0.0529296 -0.012096 0.0268713 -0.0686317 -0.0189066 -0.0268713 -0.0686317 -0.0189066 0.0268712 -0.0998468 -0.0124744 -0.0268712 -0.0998468 -0.0124744 0 -0.0748146 0.0256017 0 -0.0393893 0.0256017 0.0191712 -0.0748146 0.0220794 -0.0191712 -0.0748146 0.0220794 0.0182379 -0.0748146 0.0210424 -0.0182379 -0.0748146 0.0210424 0 -0.0393893 0.0245647 0 -0.0748146 0.0245647 0.0216682 -0.0998468 -0.0125575 -0.0216682 -0.0998468 -0.0125575 0.0216683 -0.0686317 -0.0189896 -0.0216683 -0.0686317 -0.0189896 0.0216682 -0.0529296 -0.0121791 -0.0216682 -0.0529296 -0.0121791 0.0216682 0.0032575 -0.0133142 -0.0216682 0.0032575 -0.0133142 0.0216682 0.0086289 -0.0102081 -0.0216682 0.0086289 -0.0102081 0.0216681 0.0117651 -0.0048146 -0.0216681 0.0117651 -0.0048146 0.021668 0.011922 0.0021157 -0.021668 0.011922 0.0021157 0.0182379 -0.0383065 0.0210424 -0.0182379 -0.0383065 0.0210424 0.0142089 -0.0393893 0.0245649 -0.0142089 -0.0393893 0.0245649 0.0141975 -0.0748146 0.0245649 -0.0141975 -0.0748146 0.0245649 0.021668 -0.10766 -0.0008287 -0.021668 -0.10766 -0.0008287 0.0216682 -0.104905 -0.0083083 -0.0216682 -0.104905 -0.0083083 0.0216679 -0.105566 0.0070038 -0.0216679 -0.105566 0.0070038 0.0216679 0.0088188 0.0070038 -0.0216679 0.0088188 0.0070038 0.0206395 -0.100249 0.0112405 -0.0206395 -0.100249 0.0112405 0.0187179 -0.0748146 0.0190444 -0.0187179 -0.0748146 0.0190444 0.0187613 -0.079843 0.0190444 -0.0187613 -0.079843 0.0190444 0.0184737 -0.0210323 0.0199852 -0.0184737 -0.0210323 0.0199852 0.0184239 -0.0355735 0.0202946 -0.0184239 -0.0355735 0.0202946 0.0206127 0.0037188 0.0112418 -0.0206127 0.0037188 0.0112418 ] } coordIndex [ 50 48 46 -1 47 49 51 -1 64 58 46 -1 47 59 65 -1 64 46 44 -1 45 47 65 -1 52 56 54 -1 55 57 53 -1 58 56 50 -1 51 57 59 -1 58 50 46 -1 47 51 59 -1 58 64 62 -1 63 65 59 -1 58 62 60 -1 61 63 59 -1 76 74 78 -1 79 75 77 -1 42 64 44 -1 45 65 43 -1 72 66 74 -1 75 67 73 -1 74 66 64 -1 65 67 75 -1 74 64 78 -1 79 65 75 -1 70 68 66 -1 67 69 71 -1 70 66 72 -1 73 67 71 -1 78 64 42 -1 43 65 79 -1 42 40 78 -1 79 41 43 -1 52 82 56 -1 57 83 53 -1 82 50 56 -1 57 51 83 -1 104 102 106 -1 107 103 105 -1 88 92 90 -1 91 93 89 -1 92 100 94 -1 95 101 93 -1 100 98 96 -1 97 99 101 -1 94 100 96 -1 97 101 95 -1 88 110 108 -1 109 111 89 -1 102 84 106 -1 107 85 103 -1 114 108 112 -1 109 115 113 -1 100 108 114 -1 109 101 115 -1 92 108 100 -1 109 93 101 -1 92 88 108 -1 89 93 109 -1 122 118 124 -1 119 123 125 -1 126 118 122 -1 119 127 123 -1 118 116 120 -1 117 119 121 -1 126 116 118 -1 117 127 119 -1 114 116 126 -1 117 115 127 -1 114 112 116 -1 113 115 117 -1 44 46 112 -1 113 47 45 -1 46 116 112 -1 113 117 47 -1 46 48 116 -1 117 49 47 -1 48 120 116 -1 117 121 49 -1 48 50 120 -1 121 51 49 -1 50 118 120 -1 121 119 51 -1 84 102 118 -1 119 103 85 -1 102 124 118 -1 119 125 103 -1 62 64 114 -1 115 65 63 -1 62 114 126 -1 127 115 63 -1 60 62 126 -1 127 63 61 -1 60 126 122 -1 123 127 61 -1 58 60 122 -1 123 61 59 -1 58 122 124 -1 125 123 59 -1 56 58 124 -1 125 59 57 -1 56 124 102 -1 103 125 57 -1 64 66 114 -1 115 67 65 -1 66 100 114 -1 115 101 67 -1 86 104 106 -1 107 105 86 -1 86 106 87 -1 87 107 86 -1 78 40 110 -1 111 41 79 -1 78 110 88 -1 89 111 79 -1 40 42 108 -1 109 43 41 -1 40 108 110 -1 111 109 41 -1 54 56 102 -1 103 57 55 -1 54 102 104 -1 105 103 55 -1 66 68 100 -1 101 69 67 -1 68 98 100 -1 101 99 69 -1 68 70 98 -1 99 71 69 -1 70 96 98 -1 99 97 71 -1 72 74 92 -1 93 75 73 -1 72 92 94 -1 95 93 73 -1 74 76 92 -1 93 77 75 -1 76 90 92 -1 93 91 77 -1 76 78 88 -1 89 79 77 -1 76 88 90 -1 91 89 77 -1 70 72 96 -1 97 73 71 -1 72 94 96 -1 97 95 73 -1 81 54 104 -1 105 55 81 -1 81 104 86 -1 86 105 81 -1 52 80 106 -1 107 80 53 -1 80 87 106 -1 107 87 80 -1 82 52 84 -1 85 53 83 -1 52 106 84 -1 85 107 53 -1 52 54 81 -1 81 55 53 -1 52 81 80 -1 80 81 53 -1 43 109 113 45 -1 42 44 112 108 -1 51 119 85 83 -1 50 82 84 118 -1 ] creaseAngle 0.2 } } Shape { appearance USE MOTOR_APPEARANCE geometry IndexedFaceSet { coord USE DLegUpperLCoord coordIndex [ 32 36 33 -1 33 36 38 -1 35 37 34 -1 35 39 37 -1 33 38 39 -1 33 39 35 -1 32 37 36 -1 32 34 37 -1 38 36 37 -1 38 37 39 -1 32 35 34 -1 32 33 35 -1 20 22 18 -1 20 18 16 -1 17 19 23 -1 17 23 21 -1 23 27 25 -1 23 25 21 -1 19 29 28 -1 19 17 29 -1 28 27 23 -1 28 23 19 -1 21 25 29 -1 21 29 17 -1 31 24 20 -1 31 20 16 -1 18 30 31 -1 18 31 16 -1 24 26 22 -1 24 22 20 -1 22 26 30 -1 22 30 18 -1 9 5 1 -1 9 1 13 -1 7 5 9 -1 7 9 11 -1 0 15 13 -1 0 13 1 -1 0 7 11 -1 0 11 15 -1 10 6 2 -1 10 2 14 -1 3 4 8 -1 3 8 12 -1 12 2 3 -1 12 14 2 -1 8 4 6 -1 8 6 10 -1 14 12 8 -1 14 8 10 -1 11 9 13 -1 11 13 15 -1 ] creaseAngle 0.2 } } ] } # LegLowerL %< if (enable_backlash) { >% DEF DLegLowerL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_leg_lower >% %< } else { >% DEF DLegLowerL HingeJoint { %< } >% device [ RotationalMotor { name "LegLowerL" acceleration 55 maxVelocity 12.26 minPosition -2.25 maxPosition 0.03 maxTorque 2.5 } PositionSensor { name "LegLowerLS" } ] jointParameters HingeJointParameters { axis -1 0 0 anchor -0 -0.093 0 position -2.25 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation -0 -0.093 0 rotation -1 0 0 -2.25 children [ DEF DLegLowerLShape Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DLegLowerLCoord Coordinate { point [ 0.0321921 -0.0784286 -0.0367578 -0.0321921 -0.0784286 -0.0367578 0.0311006 -0.0392151 -0.0368254 -0.0311006 -0.0392151 -0.0368254 0.030769 -0.0273114 -0.0213674 -0.030769 -0.0273114 -0.0213674 0.0303636 -0.0127552 -0.0089633 -0.0303636 -0.0127552 -0.0089633 0.0299594 0.0017595 -0.0015376 -0.0299594 0.0017595 -0.0015376 0.0295499 0.0164651 0.0041354 -0.0295499 0.0164651 0.0041354 0.0295497 0.0164712 0.0132623 -0.0295497 0.0164712 0.0132623 0.030808 -0.0287311 0.0093219 -0.030808 -0.0287311 0.0093219 0.0317893 -0.0639808 0.0020625 -0.0317893 -0.0639808 0.0020625 0.0321876 -0.0782881 -0.0018784 -0.0321876 -0.0782881 -0.0018784 0.0245216 -0.104273 0.0042722 -0.0245216 -0.104273 0.0042722 0.0275907 -0.0999268 0.0088045 -0.0275907 -0.0999268 0.0088045 0.0313282 -0.0910063 0.0009325 -0.0313282 -0.0910063 0.0009325 0.0320606 -0.0852879 -0.0019302 -0.0320606 -0.0852879 -0.0019302 0.0245218 -0.104273 -0.0063471 -0.0245218 -0.104273 -0.0063471 0.027591 -0.0999272 -0.0114838 -0.027591 -0.0999272 -0.0114838 0.0313286 -0.0910067 -0.0217641 -0.0313286 -0.0910067 -0.0217641 0.0320611 -0.0852883 -0.028391 -0.0320611 -0.0852883 -0.028391 0 -0.0583238 0.0271951 0 -0.0147893 0.0307726 0 0.0164661 0.0312491 0.0199838 -0.0583242 0.0271955 -0.0199838 -0.0583242 0.0271955 0.0199845 -0.0147896 0.0307729 -0.0199845 -0.0147896 0.0307729 0.019985 0.0164657 0.0312495 -0.019985 0.0164657 0.0312495 0.0218872 -0.0583242 0.0245715 -0.0218872 -0.0583242 0.0245715 0.0218868 -0.0862341 0.0205168 -0.0218868 -0.0862341 0.0205168 0.0266765 0.0164685 0.0225968 -0.0266765 0.0164685 0.0225968 0.0263508 -0.0217604 0.0218203 -0.0263508 -0.0217604 0.0218203 0.0265654 -0.0611524 0.0190446 -0.0265654 -0.0611524 0.0190446 0.0265862 -0.082261 0.0142788 -0.0265862 -0.082261 0.0142788 0.0288814 -0.0784285 -0.0367579 -0.0288814 -0.0784285 -0.0367579 0.0277899 -0.039215 -0.0368255 -0.0277899 -0.039215 -0.0368255 0.0274583 -0.0273113 -0.0213675 -0.0274583 -0.0273113 -0.0213675 0.0270529 -0.0127551 -0.0089634 -0.0270529 -0.0127551 -0.0089634 0.0266488 0.0017595 -0.0015377 -0.0266488 0.0017595 -0.0015377 0.0262392 0.0164652 0.0041353 -0.0262392 0.0164652 0.0041353 0.026239 0.0164713 0.0132622 -0.026239 0.0164713 0.0132622 0.021211 -0.104273 0.0042722 -0.021211 -0.104273 0.0042722 0.02428 -0.0999268 0.0088045 -0.02428 -0.0999268 0.0088045 0.0212111 -0.104273 -0.0063472 -0.0212111 -0.104273 -0.0063472 0.0242804 -0.0999271 -0.0114838 -0.0242804 -0.0999271 -0.0114838 0.0280179 -0.0910066 -0.0217641 -0.0280179 -0.0910066 -0.0217641 0.0287504 -0.0852883 -0.0283911 -0.0287504 -0.0852883 -0.0283911 0.0175987 -0.0583242 0.0248103 -0.0175987 -0.0583242 0.0248103 0.0175999 0.0164657 0.0288643 -0.0175999 0.0164657 0.0288643 0.0195021 -0.0583242 0.0221864 -0.0195021 -0.0583242 0.0221864 0.0195017 -0.0862341 0.0181316 -0.0195017 -0.0862341 0.0181316 0.0242914 0.0164685 0.0202117 -0.0242914 0.0164685 0.0202117 0 -0.0583239 0.0243141 0 0.016466 0.0283681 ] } coordIndex [ 10 12 14 -1 15 13 11 -1 10 14 16 -1 17 15 11 -1 8 10 16 -1 17 11 9 -1 8 16 18 -1 19 17 9 -1 6 8 18 -1 19 9 7 -1 18 0 6 -1 7 1 19 -1 6 0 4 -1 5 1 7 -1 4 0 2 -1 3 1 5 -1 30 22 20 -1 21 23 31 -1 24 22 30 -1 31 23 25 -1 30 20 28 -1 29 21 31 -1 32 24 30 -1 31 25 33 -1 26 24 32 -1 33 25 27 -1 0 18 26 -1 27 19 1 -1 34 26 32 -1 33 27 35 -1 0 26 34 -1 35 27 1 -1 55 22 24 -1 25 23 56 -1 26 18 55 -1 56 19 27 -1 26 55 24 -1 25 56 27 -1 22 55 47 -1 48 56 23 -1 45 47 55 53 -1 56 48 46 54 -1 16 53 55 18 -1 56 54 17 19 -1 45 53 51 -1 52 54 46 -1 14 51 53 16 -1 54 52 15 17 -1 12 49 51 14 -1 52 50 13 15 -1 39 45 41 -1 42 46 40 -1 41 45 51 -1 52 46 42 -1 41 51 49 43 -1 50 52 42 44 -1 36 39 41 37 -1 42 40 36 37 -1 37 41 43 38 -1 44 42 37 38 -1 12 69 91 49 -1 92 70 13 50 -1 10 67 69 12 -1 70 68 11 13 -1 8 65 67 10 -1 68 66 9 11 -1 6 63 65 8 -1 66 64 7 9 -1 4 61 63 6 -1 64 62 5 7 -1 43 49 91 85 -1 92 50 44 86 -1 2 59 61 4 -1 62 60 3 5 -1 0 57 59 2 -1 60 58 1 3 -1 0 34 81 57 -1 82 35 1 58 -1 32 79 81 34 -1 82 80 33 35 -1 30 77 79 32 -1 80 78 31 33 -1 28 75 77 30 -1 78 76 29 31 -1 20 71 75 28 -1 76 72 21 29 -1 20 22 73 71 -1 74 23 21 72 -1 22 47 89 73 -1 90 48 23 74 -1 45 87 89 47 -1 90 88 46 48 -1 39 83 87 45 -1 88 84 40 46 -1 38 43 85 94 -1 86 44 38 94 -1 36 93 83 39 -1 84 93 36 40 -1 83 93 94 85 -1 94 93 84 86 -1 83 85 91 87 -1 92 86 84 88 -1 87 91 89 -1 90 92 88 -1 73 89 91 -1 92 90 74 -1 69 73 91 -1 92 74 70 -1 69 71 73 -1 74 72 70 -1 69 75 71 -1 72 76 70 -1 79 75 69 -1 70 76 80 -1 81 79 69 -1 70 80 82 -1 57 81 69 -1 70 82 58 -1 79 77 75 -1 76 78 80 -1 63 57 65 -1 66 58 64 -1 61 57 63 -1 64 58 62 -1 59 57 61 -1 62 58 60 -1 57 69 65 -1 66 70 58 -1 65 69 67 -1 68 70 66 -1 ] creaseAngle 0.2 } } # AnkleL %< if (enable_backlash) { >% DEF DAnkleL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_ankle >% %< } else { >% DEF DAnkleL HingeJoint { %< } >% device [ RotationalMotor { name "AnkleL" acceleration 55 maxVelocity 12.26 minPosition -1.39 maxPosition 1.22 maxTorque 2.5 } PositionSensor { name "AnkleLS" } ] jointParameters HingeJointParameters { axis 1 0 0 anchor 0 -0.093 0 position -1.23 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 -0.093 0 rotation 1 0 0 -1.23 children [ DEF DAnkleLShape Shape { appearance USE MOTOR_APPEARANCE geometry IndexedFaceSet { coord DEF Dcoord_AnkleL Coordinate { point [ 0.0180435 -0.0121964 0.0214744 0.0180442 -0.0122006 -0.0191612 -0.0175735 -0.0121994 -0.0191612 -0.0175742 -0.0121951 0.0214745 0.0180458 0.0384658 -0.0141346 -0.0175718 0.0384671 -0.0141346 -0.017572 0.0268712 -0.0268364 -0.0175714 0.0268675 -0.0618517 0.0180463 0.0268663 -0.0618511 0.0180457 0.0268699 -0.0268358 -0.0175731 -0.0063734 -0.0268329 -0.0175725 -0.0063771 -0.0618482 0.0180451 -0.0063783 -0.0618476 0.0180445 -0.0063747 -0.0268323 0.0180443 0.0122078 0.0214719 -0.0175733 0.012209 0.0214719 -0.0175733 0.0122086 0.0173243 0.0180444 0.0122073 0.0173243 0.0155883 0.0384659 -0.0141344 -0.0151072 0.038467 -0.0141347 -0.0151073 0.0122085 0.0173242 0.0155882 0.0122074 0.0173245 -0.0151072 0.0122079 0.0113894 0.0155883 0.0122068 0.01139 0.015589 0.0324513 0.0113879 -0.0151065 0.0324524 0.0113873 -0.0151059 0.0324492 -0.0190551 0.0155895 0.0324481 -0.0190548 0.0180457 0.032448 -0.0190548 -0.0175719 0.0324493 -0.0190552 0.0155889 0.0324519 0.0173224 0.0180451 0.0324518 0.0173222 -0.0175726 0.0324531 0.0173222 -0.0151066 0.032453 0.017322 0.0180454 0.0384685 0.0113873 0.015589 0.0384686 0.0113872 -0.0151065 0.0384696 0.0113867 -0.0175722 0.0384697 0.0113866 -0.0175719 0.0268709 -0.0296622 -0.0175714 0.0268678 -0.0590251 0.0180462 0.0268666 -0.0590245 0.0180457 0.0268697 -0.0296616 -0.0175731 -0.0063737 -0.0296588 -0.0175726 -0.0063768 -0.0590216 0.0180451 -0.006378 -0.059021 0.0180445 -0.006375 -0.0296581 -0.0125418 0.0326944 -0.0590256 -0.0125423 0.0326975 -0.0296628 0.012852 0.0326966 -0.0296623 0.0128525 0.0326935 -0.0590252 -0.0125434 -0.0122037 -0.0590209 -0.0125439 -0.0122006 -0.0296581 0.0128504 -0.0122015 -0.0296576 0.0128509 -0.0122046 -0.0590205 0.012851 -0.0122049 -0.0618471 0.0128504 -0.0122012 -0.0268318 0.0128525 0.0326932 -0.0618518 0.0128519 0.0326969 -0.0268365 -0.0125433 -0.012204 -0.0618475 -0.0125417 0.0326941 -0.0618522 -0.0125424 0.0326978 -0.026837 -0.0125439 -0.0122003 -0.0268323 -0.0097551 0.0087803 -0.0157662 -0.0097549 0.0087788 -0.0307525 -0.0097547 0.0147396 -0.0307532 -0.0097549 0.0147411 -0.0157668 0.0100627 0.0087796 -0.0157659 0.010063 0.008778 -0.0307522 0.0100632 0.0147388 -0.0307528 0.0100629 0.0147404 -0.0157665 0.0100635 0.0318247 -0.0157683 0.0100637 0.0318232 -0.0307546 0.0100635 0.0258624 -0.030754 0.0100633 0.0258639 -0.0157676 -0.0097544 0.0318255 -0.0157686 -0.0097541 0.0318239 -0.030755 -0.0097543 0.0258631 -0.0307543 -0.0097546 0.0258647 -0.015768 ] } coordIndex [ 0 1 14 -1 15 2 3 -1 1 17 14 -1 2 15 16 -1 16 15 20 -1 21 14 17 -1 22 25 33 -1 27 24 35 -1 5 19 26 -1 4 27 18 -1 4 28 27 -1 1 27 28 -1 1 28 17 -1 5 26 29 -1 2 29 26 -1 2 16 29 -1 33 25 36 -1 35 24 30 -1 33 20 22 -1 35 18 27 -1 31 17 28 -1 37 5 29 -1 75 77 74 -1 75 76 77 -1 73 71 70 -1 73 72 71 -1 77 72 73 -1 77 76 72 -1 75 70 71 -1 75 74 70 -1 64 69 68 -1 64 65 69 -1 62 67 66 -1 62 63 67 -1 66 68 69 -1 66 67 68 -1 64 62 65 -1 64 63 62 -1 46 51 47 -1 46 50 51 -1 56 59 46 -1 56 46 49 -1 46 47 48 -1 46 48 49 -1 47 57 48 -1 47 60 57 -1 55 61 51 -1 55 51 52 -1 54 50 58 -1 54 53 50 -1 50 53 52 -1 50 52 51 -1 38 51 42 -1 38 47 51 -1 6 47 38 -1 6 60 47 -1 6 61 60 -1 6 10 61 -1 10 51 61 -1 10 42 51 -1 11 50 43 -1 11 58 50 -1 39 50 46 -1 39 43 50 -1 7 58 11 -1 7 59 58 -1 7 46 59 -1 7 39 46 -1 9 48 57 -1 9 41 48 -1 9 55 13 -1 9 57 55 -1 13 52 45 -1 13 55 52 -1 8 49 40 -1 8 56 49 -1 12 53 54 -1 12 44 53 -1 8 12 54 -1 8 54 56 -1 40 53 44 -1 40 49 53 -1 55 57 60 -1 55 60 61 -1 56 54 58 -1 56 58 59 -1 48 52 53 -1 48 53 49 -1 40 12 8 -1 40 44 12 -1 9 45 41 -1 9 13 45 -1 38 10 6 -1 38 42 10 -1 7 43 39 -1 7 11 43 -1 36 32 33 -1 36 37 32 -1 30 34 35 -1 30 31 34 -1 29 16 37 -1 37 16 32 -1 28 34 31 -1 28 4 34 -1 1 26 27 -1 1 2 26 -1 26 19 25 -1 25 19 36 -1 24 26 25 -1 24 27 26 -1 23 30 24 -1 23 21 30 -1 23 25 22 -1 23 24 25 -1 14 20 15 -1 14 21 20 -1 20 23 22 -1 20 21 23 -1 36 5 37 -1 36 19 5 -1 34 18 35 -1 34 4 18 -1 32 20 33 -1 32 16 20 -1 30 17 31 -1 30 21 17 -1 3 0 14 -1 14 15 3 -1 0 2 1 -1 0 3 2 -1 41 45 52 48 -1 ] creaseAngle 0.2 } } # FootL %< if (enable_backlash) { >% DEF DFootL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_foot >% %< } else { >% DEF DFootL HingeJoint { %< } >% device [ RotationalMotor { name "FootL" acceleration 55 maxVelocity 12.26 minPosition -1.02 maxPosition 0.6 maxTorque 2.5 } PositionSensor { name "FootLS" } ] jointParameters HingeJointParameters { axis 0 0 1 position -0.02 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { rotation 0 0 1 -0.02 children [ DEF LEFT_FOOT_SLOT Group { children IS leftFootSlot } DEF DFootLShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DFootLCoord Coordinate { point [ -0.0087402 0.0067738 0.0246943 -0.0087402 -0.0101185 0.0246961 -0.0002941 -0.0136169 0.024697 0.008152 -0.0101184 0.0246972 0.0116505 -0.0016379 0.0246966 0.008152 0.0067738 0.0246955 -0.0002941 0.0102723 0.0246945 -0.0087401 0.0067735 0.0225305 -0.0122386 -0.0016381 0.0225311 -0.0087401 -0.0101187 0.0225322 -0.000294 -0.0136172 0.0225332 0.0081521 -0.0101187 0.0225334 0.0116506 -0.0016381 0.0225328 0.0081521 0.0067735 0.0225316 -0.000294 0.010272 0.0225307 -0.0002906 0.010267 -0.0258945 0.0081555 0.0067685 -0.0258936 0.011654 -0.0016432 -0.0258925 0.0081555 -0.0101237 -0.0258918 -0.0002906 -0.0136222 -0.025892 -0.0087367 -0.0101237 -0.025893 -0.0122352 -0.0016432 -0.0258941 -0.0087367 0.0067685 -0.0258948 -0.0002907 0.0102672 -0.0238477 0.0081554 0.0067687 -0.0238467 0.0116539 -0.001643 -0.0238456 0.0081554 -0.0101235 -0.0238449 -0.0002907 -0.013622 -0.0238452 -0.0087369 -0.0101235 -0.0238461 -0.0087369 0.0067687 -0.0238479 0.0105403 -0.0309114 0.0262598 0.0105438 -0.0309167 -0.0238425 -0.0112658 -0.0309114 0.0262583 -0.0112623 -0.0309167 -0.023844 -0.0112624 -0.0295248 -0.0223178 -0.0112657 -0.0295198 0.024698 0.0105404 -0.0295198 0.0246995 0.0105437 -0.0295248 -0.0223163 0.0105436 -0.0016428 -0.0223194 0.0105404 -0.0016379 0.0246965 -0.0112658 -0.0016379 0.024695 -0.0112625 -0.0016428 -0.0223209 -0.0112624 -0.001643 -0.0238472 -0.0112659 -0.0016377 0.0262551 0.0105403 -0.0016377 0.0262567 0.0105437 -0.001643 -0.0238457 -0.003267 0.0013025 -0.0264138 -0.0044998 -0.0016546 -0.0264136 -0.003267 -0.0046503 -0.0264132 -0.0002906 -0.0058831 -0.0264128 0.0026858 -0.0046503 -0.0264128 0.0039187 -0.0016546 -0.026413 0.0026858 0.0013025 -0.0264134 -0.0002906 0.0025354 -0.0264137 -0.0002943 0.0025409 0.0266983 0.0026821 0.0013081 0.0266986 0.003915 -0.0016491 0.026699 0.0026821 -0.0046447 0.0266992 -0.0002943 -0.0058776 0.0266991 -0.0032707 -0.0046447 0.0266988 -0.0045035 -0.0016491 0.0266984 -0.0032707 0.0013081 0.0266982 -0.0221594 -0.0182954 -0.0532328 0.0440031 -0.0182966 -0.0532305 0.0440028 -0.0335107 -0.0532297 -0.0221597 -0.0335494 -0.053232 -0.0145455 -0.0335441 0.0507272 0.0376511 -0.0335051 0.0503662 0.0376513 -0.0238991 0.0503657 -0.0145454 -0.0238982 0.0507267 -0.022162 -0.0182915 0.0211815 0.0440005 -0.0182927 0.0211838 -0.0075757 -0.0335441 0.0521784 0.0298263 -0.0335448 0.0521797 0.0298265 -0.0238989 0.0521792 -0.0075755 -0.0238982 0.0521779 -0.0221629 -0.0226602 0.0447686 0.0439996 -0.0226613 0.0447709 -0.0221631 -0.0335044 0.0447691 0.0439994 -0.0335055 0.0447714 ] } coordIndex [ 76 70 66 -1 71 77 67 -1 70 76 75 -1 76 69 75 -1 68 77 74 -1 77 71 74 -1 67 73 79 -1 64 79 73 -1 64 77 79 -1 63 77 64 -1 63 71 77 -1 62 76 70 -1 65 72 78 -1 66 78 72 -1 62 65 76 -1 65 78 76 -1 66 69 78 -1 69 76 78 -1 67 79 68 -1 79 77 68 -1 75 74 71 -1 75 71 70 -1 75 69 66 -1 75 66 72 -1 74 75 72 -1 74 72 73 -1 68 74 67 -1 74 73 67 -1 73 72 64 -1 72 65 64 -1 62 70 71 -1 62 71 63 -1 62 63 64 -1 62 64 65 -1 ] creaseAngle 0.2 } } Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord USE DFootLCoord coordIndex [ 1 2 3 -1 40 1 3 -1 40 3 4 -1 0 40 4 -1 0 4 5 -1 0 5 6 -1 9 11 10 -1 9 12 11 -1 8 12 9 -1 7 12 8 -1 7 13 12 -1 14 13 7 -1 28 27 26 -1 42 28 26 -1 42 26 25 -1 29 42 25 -1 29 25 24 -1 29 24 23 -1 20 18 19 -1 20 17 18 -1 21 17 20 -1 22 17 21 -1 22 16 17 -1 15 16 22 -1 53 52 46 -1 46 52 51 -1 46 51 47 -1 47 51 48 -1 48 51 50 -1 48 50 49 -1 55 54 61 -1 55 61 56 -1 56 61 60 -1 56 60 59 -1 56 59 57 -1 57 59 58 -1 47 61 46 -1 47 60 61 -1 48 60 47 -1 48 59 60 -1 49 59 48 -1 49 58 59 -1 50 58 49 -1 50 57 58 -1 51 57 50 -1 51 56 57 -1 52 56 51 -1 52 55 56 -1 53 55 52 -1 53 54 55 -1 46 54 53 -1 46 61 54 -1 38 34 37 -1 38 41 34 -1 36 40 39 -1 36 35 40 -1 42 38 45 -1 42 41 38 -1 44 40 43 -1 44 39 40 -1 33 45 31 -1 33 42 45 -1 30 43 32 -1 30 44 43 -1 34 42 33 -1 34 41 42 -1 32 43 35 -1 35 43 40 -1 36 44 30 -1 36 39 44 -1 31 45 37 -1 37 45 38 -1 29 22 21 -1 29 21 42 -1 42 21 20 -1 42 20 28 -1 28 20 19 -1 28 19 27 -1 27 19 18 -1 27 18 26 -1 26 18 17 -1 26 17 25 -1 25 17 16 -1 25 16 24 -1 24 16 15 -1 24 15 23 -1 23 15 22 -1 23 22 29 -1 7 0 6 -1 7 6 14 -1 5 13 14 -1 5 14 6 -1 4 12 13 -1 4 13 5 -1 3 11 12 -1 3 12 4 -1 2 10 11 -1 2 11 3 -1 1 9 10 -1 1 10 2 -1 40 8 9 -1 40 9 1 -1 0 7 8 -1 0 8 40 -1 ] creaseAngle 0.2 } } ] } ] boundingObject Pose { translation 0.011 -0.027 -0.001 children [ Box { size 0.066 0.013 0.105 } ] } physics Physics { density -1 mass 0.0794462 centerOfMass [ 0.00950588 -0.0259953 -0.000502877 ] inertiaMatrix [ 6.8325629e-05 8.7890505e-05 3.5840758e-05 2.5330463e-06 2.1869558e-07 9.7620541e-07 ] } } } ] boundingObject Pose { translation 0 0.01 -0.0205 children [ Box { size 0.036 0.045 0.083 } ] } physics Physics { density -1 mass 0.167108 centerOfMass [ -0.000213732 0.0138731 -0.0185361 ] inertiaMatrix [ 1.2079175e-04 1.0885465e-04 4.1871103e-05 -7.9781067e-07 -3.9322246e-07 7.0770117e-06 ] } } } ] boundingObject Group { children [ Pose { translation 0 -0.058 -0.001 children [ Box { size 0.064 0.034 0.041 } ] } Pose { translation 0 -0.02 0.016 rotation 1 0 0 0.04 children [ Box { size 0.062 0.073 0.027 } ] } ] } physics Physics { density -1 mass 0.0703098 centerOfMass [ -0.000592469 -0.0539545 0.00654763 ] inertiaMatrix [ 9.3369608e-05 4.6295534e-05 1.1351516e-04 -9.3567395e-07 -2.3992085e-07 -1.2858493e-05 ] } } } ] boundingObject Pose { translation 0 -0.058 0.006 children [ Box { size 0.053 0.035 0.042 } ] } physics Physics { density -1 mass 0.119043 centerOfMass [ -0.000322635 -0.0629655 0.000691906 ] inertiaMatrix [ 9.7950272e-05 3.2848287e-05 1.1493509e-04 1.2119368e-06 -2.1223016e-07 -1.9474021e-06 ] } } } ] boundingObject Pose { translation 0 -0.0105 -0.023 children [ Box { size 0.036 0.043 0.077 } ] } physics Physics { density -1 mass 0.167108 centerOfMass [ 7.99828e-05 -0.0138731 -0.0182424 ] inertiaMatrix [ 1.2259691e-04 1.1066637e-04 4.1877668e-05 7.1127469e-07 8.1143913e-07 -7.1635476e-06 ] } } } ] name "pelvYL" boundingObject Pose { translation 0 0.017 0.001 children [ Box { size 0.022 0.028 0.05 } ] } physics Physics { density -1 mass 0.0270692 centerOfMass [ 0.00048 -0.0 0.01844 ] inertiaMatrix [ 1.5019148e-05 1.1328768e-05 6.1825529e-06 0.0000000e+00 0.0000000e+00 -7.3350016e-07 ] } } } # PelvYR %< if (enable_backlash) { >% DEF DPelvYR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_pelv_y >% %< } else { >% DEF DPelvYR HingeJoint { %< } >% device [ RotationalMotor { name "PelvYR" acceleration 55 maxVelocity 12.26 minPosition -2.42 maxPosition 0.66 maxTorque 2.5 } PositionSensor { name "PelvYRS" } ] jointParameters HingeJointParameters { axis 0 0 -1 anchor -0.005 -0.037 -0.1222 position -0.01 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation -0.005 -0.037 -0.122 rotation 0.5735 0.5793 0.5793 2.1002 children [ DEF DPelvYRShape Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord Coordinate { point [ -0.008447 -0.0084461 0.0247275 -0.008447 0.0084461 0.0247275 -9e-07 0.0119446 0.0247278 0.0084452 0.0084461 0.0247281 0.0119437 -3.45e-05 0.0247282 0.0084452 -0.0084461 0.0247281 -9e-07 -0.0119446 0.0247278 -0.0084469 -0.0084461 0.0225637 -0.0119454 -3.45e-05 0.0225636 -0.0084469 0.0084461 0.0225637 -8e-07 0.0119446 0.022564 0.0084453 0.0084461 0.0225643 0.0119438 -3.45e-05 0.0225644 0.0084453 -0.0084461 0.0225643 -8e-07 -0.0119446 0.022564 9e-07 -0.0119446 -0.0258612 0.008447 -0.0084461 -0.0258609 0.0119455 -3.45e-05 -0.0258608 0.008447 0.0084461 -0.0258609 9e-07 0.0119446 -0.0258612 -0.0084452 0.0084461 -0.0258615 -0.0119437 -3.45e-05 -0.0258616 -0.0084452 -0.0084461 -0.0258615 8e-07 -0.0119446 -0.0238143 0.0084469 -0.0084461 -0.0238141 0.0119454 -3.45e-05 -0.0238139 0.0084469 0.0084461 -0.0238141 8e-07 0.0119446 -0.0238143 -0.0084453 0.0084461 -0.0238146 -0.0084453 -0.0084461 -0.0238146 0.0108336 0.0313981 0.0262884 0.0108353 0.0313981 -0.023814 -0.0109726 0.0313981 0.0262876 -0.0109708 0.0313981 -0.0238147 -0.0109709 0.0300063 -0.0222884 -0.0109725 0.0300063 0.0247274 0.0108336 0.0300063 0.0247282 0.0108353 0.0300063 -0.0222877 0.0108353 -3.45e-05 -0.0222877 0.0108336 -3.45e-05 0.0247282 -0.0109725 -3.45e-05 0.0247274 -0.0109709 -3.45e-05 -0.0222884 -0.0109708 -3.45e-05 -0.0238147 -0.0109726 -3.45e-05 0.0262876 0.0108336 -3.45e-05 0.0262884 0.0108353 -3.45e-05 -0.023814 3e-07 0.0332829 -0.010382 0.0073414 0.0332829 -0.0073409 0.010382 0.0332829 4e-07 0.0073409 0.0332829 0.0073414 -4e-07 0.0332829 0.010382 -0.0073414 0.0332829 0.0073409 -0.010382 0.0332829 -4e-07 -0.0073409 0.0332829 -0.0073414 4e-07 0.0313981 -0.010382 0.0073414 0.0313981 -0.0073409 0.010382 0.0313981 4e-07 0.0073409 0.0313981 0.0073414 -4e-07 0.0313981 0.010382 -0.0073414 0.0313981 0.0073409 -0.010382 0.0313981 -4e-07 -0.0073409 0.0313981 -0.0073414 -0.0029755 -0.0029802 -0.0263813 -0.0042083 -2.31e-05 -0.0263814 -0.0029755 0.0029726 -0.0263813 9e-07 0.0042054 -0.0263812 0.0029773 0.0029726 -0.0263811 0.0042102 -2.31e-05 -0.0263811 0.0029773 -0.0029802 -0.0263811 9e-07 -0.0042131 -0.0263812 -9e-07 -0.0042131 0.0267308 0.0029755 -0.0029802 0.0267309 0.0042083 -2.31e-05 0.0267309 0.0029755 0.0029726 0.0267309 -9e-07 0.0042054 0.0267308 -0.0029773 0.0029726 0.0267307 -0.0042102 -2.31e-05 0.0267306 -0.0029773 -0.0029802 0.0267307 ] } coordIndex [ 1 3 2 -1 40 3 1 -1 40 4 3 -1 0 4 40 -1 0 5 4 -1 0 6 5 -1 9 10 11 -1 9 11 12 -1 8 9 12 -1 7 8 12 -1 7 12 13 -1 14 7 13 -1 46 53 47 -1 53 48 47 -1 53 52 48 -1 52 51 48 -1 51 49 48 -1 51 50 49 -1 28 26 27 -1 42 26 28 -1 42 25 26 -1 29 25 42 -1 29 24 25 -1 29 23 24 -1 20 19 18 -1 20 18 17 -1 21 20 17 -1 22 21 17 -1 22 17 16 -1 15 22 16 -1 69 62 68 -1 62 67 68 -1 62 63 67 -1 63 64 67 -1 64 66 67 -1 64 65 66 -1 71 77 70 -1 71 72 77 -1 72 76 77 -1 72 75 76 -1 72 73 75 -1 73 74 75 -1 63 62 77 -1 63 77 76 -1 64 63 76 -1 64 76 75 -1 65 64 75 -1 65 75 74 -1 66 65 74 -1 66 74 73 -1 67 66 73 -1 67 73 72 -1 68 67 72 -1 68 72 71 -1 69 68 71 -1 69 71 70 -1 62 69 70 -1 62 70 77 -1 61 52 53 -1 61 60 52 -1 60 51 52 -1 60 59 51 -1 59 50 51 -1 59 58 50 -1 58 49 50 -1 58 57 49 -1 57 48 49 -1 57 56 48 -1 56 47 48 -1 56 55 47 -1 55 46 47 -1 55 54 46 -1 53 54 61 -1 53 46 54 -1 38 37 34 -1 38 34 41 -1 36 39 40 -1 36 40 35 -1 34 37 36 -1 34 36 35 -1 42 45 38 -1 42 38 41 -1 44 43 40 -1 44 40 39 -1 33 31 45 -1 33 45 42 -1 30 32 43 -1 30 43 44 -1 34 33 42 -1 34 42 41 -1 32 35 43 -1 35 40 43 -1 36 30 44 -1 36 44 39 -1 31 37 45 -1 37 38 45 -1 30 36 31 -1 36 37 31 -1 33 34 35 -1 33 35 32 -1 30 31 33 -1 30 33 32 -1 29 21 22 -1 29 42 21 -1 42 20 21 -1 42 28 20 -1 28 19 20 -1 28 27 19 -1 27 18 19 -1 27 26 18 -1 26 17 18 -1 26 25 17 -1 25 16 17 -1 25 24 16 -1 24 15 16 -1 24 23 15 -1 23 22 15 -1 23 29 22 -1 6 0 7 -1 7 14 6 -1 5 14 13 -1 5 6 14 -1 4 13 12 -1 4 5 13 -1 3 12 11 -1 3 4 12 -1 2 11 10 -1 2 3 11 -1 1 10 9 -1 1 2 10 -1 40 9 8 -1 40 1 9 -1 0 8 7 -1 0 40 8 -1 ] creaseAngle 0.2 } } # PelvR %< if (enable_backlash) { >% DEF DPelvR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_pelv >% %< } else { >% DEF DPelvR HingeJoint { %< } >% device [ RotationalMotor { name "PelvR" acceleration 55 maxVelocity 12.26 minPosition -1.01 maxPosition 1.01 maxTorque 2.5 } PositionSensor { name "PelvRS" } ] jointParameters HingeJointParameters { axis 0 0 -1 position 0.02 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { rotation 0 0 -1 0.02 children [ DEF DPelvRShape Shape { appearance USE MOTOR_APPEARANCE geometry IndexedFaceSet { coord Coordinate { point [ -0.0180427 0.0115768 0.0214738 -0.0180448 0.0115768 -0.0191618 0.0175728 0.0115755 -0.019163 0.0175749 0.0115755 0.0214726 -0.0180464 -0.0390891 -0.0141299 0.0175713 -0.0390904 -0.0141311 0.017571 -0.0274958 -0.0268342 0.0175692 -0.0274958 -0.0618495 -0.0180484 -0.0274946 -0.0618476 -0.0180466 -0.0274946 -0.0268323 0.0175722 0.0057488 -0.0268342 0.0175704 0.0057488 -0.0618495 -0.0180473 0.00575 -0.0618476 -0.0180455 0.00575 -0.0268323 -0.0180436 -0.0128273 0.0214738 0.0175741 -0.0128286 0.0214726 0.0175739 -0.0128286 0.017325 -0.0180438 -0.0128273 0.0173263 -0.0155888 -0.0390892 -0.0141298 0.0151067 -0.0390903 -0.0141312 0.0151079 -0.0128285 0.0173249 -0.0155876 -0.0128274 0.0173263 0.0151076 -0.0128285 0.0113902 -0.0155879 -0.0128274 0.0113918 -0.0155886 -0.0330719 0.0113918 0.0151069 -0.033073 0.0113902 0.0151053 -0.033073 -0.0190522 -0.0155902 -0.0330719 -0.0190508 -0.0180464 -0.0330718 -0.0190507 0.0175712 -0.0330731 -0.0190524 -0.0155883 -0.0330719 0.0173263 -0.0180445 -0.0330718 0.0173263 0.0175731 -0.0330731 0.017325 0.0151072 -0.033073 0.0173249 -0.018045 -0.0390891 0.011392 -0.0155886 -0.0390892 0.0113918 0.0151069 -0.0390903 0.0113902 0.0175726 -0.0390904 0.0113901 0.0175709 -0.0274958 -0.02966 0.0175693 -0.0274958 -0.0590229 -0.0180483 -0.0274946 -0.059021 -0.0180468 -0.0274946 -0.0296581 0.017572 0.0057488 -0.02966 0.0175705 0.0057488 -0.0590229 -0.0180471 0.00575 -0.059021 -0.0180456 0.00575 -0.0296581 0.0125397 -0.0333224 -0.0590226 0.0125413 -0.0333224 -0.0296597 -0.012853 -0.0333215 -0.0296584 -0.0128546 -0.0333215 -0.0590213 0.0125413 0.0115757 -0.0590226 0.0125428 0.0115757 -0.0296597 -0.0128515 0.0115766 -0.0296584 -0.012853 0.0115766 -0.0590213 -0.0128531 0.0115766 -0.0618479 -0.0128513 0.0115766 -0.0268326 -0.0128547 -0.0333215 -0.0618479 -0.0128529 -0.0333215 -0.0268326 0.0125411 0.0115757 -0.0618492 0.0125396 -0.0333224 -0.0618492 0.0125414 -0.0333224 -0.0268339 0.012543 0.0115757 -0.0268339 0.0097546 -0.0094038 -0.0157656 0.0097538 -0.0094038 -0.0307519 0.0097536 -0.0153646 -0.0307519 0.0097544 -0.0153646 -0.0157656 -0.0100633 -0.0094031 -0.0157646 -0.0100641 -0.0094031 -0.0307509 -0.0100643 -0.0153638 -0.0307509 -0.0100635 -0.0153638 -0.0157645 -0.010064 -0.0324482 -0.0157645 -0.0100648 -0.0324482 -0.0307509 -0.0100646 -0.0264874 -0.0307509 -0.0100638 -0.0264874 -0.0157646 0.0097538 -0.032449 -0.0157656 0.009753 -0.032449 -0.0307519 0.0097532 -0.0264882 -0.0307519 0.009754 -0.0264882 -0.0157656 ] } coordIndex [ 0 1 14 -1 15 2 3 -1 1 17 14 -1 2 15 16 -1 16 15 20 -1 21 14 17 -1 22 25 33 -1 27 24 35 -1 5 19 26 -1 4 27 18 -1 4 28 27 -1 1 27 28 -1 1 28 17 -1 5 26 29 -1 2 29 26 -1 2 16 29 -1 33 25 36 -1 35 24 30 -1 33 20 22 -1 35 18 27 -1 31 17 28 -1 37 5 29 -1 75 77 74 -1 75 76 77 -1 73 71 70 -1 73 72 71 -1 77 72 73 -1 77 76 72 -1 75 70 71 -1 75 74 70 -1 64 69 68 -1 64 65 69 -1 62 67 66 -1 62 63 67 -1 66 68 69 -1 66 67 68 -1 64 62 65 -1 64 63 62 -1 46 51 47 -1 46 50 51 -1 56 59 46 -1 56 46 49 -1 46 47 48 -1 46 48 49 -1 47 57 48 -1 47 60 57 -1 55 61 51 -1 55 51 52 -1 54 50 58 -1 54 53 50 -1 50 53 52 -1 50 52 51 -1 38 51 42 -1 38 47 51 -1 6 47 38 -1 6 60 47 -1 6 61 60 -1 6 10 61 -1 10 51 61 -1 10 42 51 -1 11 50 43 -1 11 58 50 -1 39 50 46 -1 39 43 50 -1 7 58 11 -1 7 59 58 -1 7 46 59 -1 7 39 46 -1 9 48 57 -1 9 41 48 -1 9 55 13 -1 9 57 55 -1 13 52 45 -1 13 55 52 -1 8 49 40 -1 8 56 49 -1 12 53 54 -1 12 44 53 -1 8 12 54 -1 8 54 56 -1 40 53 44 -1 40 49 53 -1 55 57 60 -1 55 60 61 -1 56 54 58 -1 56 58 59 -1 48 52 53 -1 48 53 49 -1 40 12 8 -1 40 44 12 -1 9 45 41 -1 9 13 45 -1 38 10 6 -1 38 42 10 -1 7 43 39 -1 7 11 43 -1 36 32 33 -1 36 37 32 -1 30 34 35 -1 30 31 34 -1 29 16 37 -1 37 16 32 -1 28 34 31 -1 28 4 34 -1 1 26 27 -1 1 2 26 -1 26 19 25 -1 25 19 36 -1 24 26 25 -1 24 27 26 -1 23 30 24 -1 23 21 30 -1 23 25 22 -1 23 24 25 -1 14 20 15 -1 14 21 20 -1 20 23 22 -1 20 21 23 -1 36 5 37 -1 36 19 5 -1 34 18 35 -1 34 4 18 -1 32 20 33 -1 32 16 20 -1 30 17 31 -1 30 21 17 -1 3 0 14 -1 14 15 3 -1 0 2 1 -1 0 3 2 -1 41 45 52 48 -1 ] creaseAngle 0.2 } } # LegUpperR %< if (enable_backlash) { >% DEF DLegUpperR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_leg_upper >% %< } else { >% DEF DLegUpperR HingeJoint { %< } >% device [ RotationalMotor { name "LegUpperR" acceleration 55 maxVelocity 12.26 minPosition -1.77 maxPosition 0.45 maxTorque 2.5 } PositionSensor { name "LegUpperRS" } ] jointParameters HingeJointParameters { axis 1 0 0 position -1.15 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { rotation 1 0 0 -1.15 children [ DEF DLegUpperRShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DLegUpperRCoord Coordinate { point [ -0.0148691 -0.0550757 0.0116409 -0.0148698 -0.105434 0.0116417 -0.0148704 -0.0550762 -0.0137534 -0.0148712 -0.105434 -0.0137526 -0.0104674 -0.105434 -0.0137528 -0.0104661 -0.105434 0.0116415 -0.0104666 -0.0550762 -0.0137536 -0.0104653 -0.0550758 0.0116407 -0.0104676 -0.0995202 -0.0189469 -0.0104657 -0.0995196 0.0166708 -0.010467 -0.0609905 -0.0189474 -0.0104651 -0.0609898 0.0166702 -0.0148713 -0.0995202 -0.0189466 -0.0148695 -0.0995195 0.016671 -0.0148708 -0.0609904 -0.0189472 -0.0148689 -0.0609898 0.0166705 0.0103659 -0.0609898 0.0166687 0.010364 -0.0609904 -0.0189489 0.0103653 -0.0995195 0.0166693 0.0103635 -0.0995202 -0.0189484 0.0147697 -0.0609898 0.0166684 0.0147678 -0.0609905 -0.0189492 0.0147691 -0.0995196 0.016669 0.0147672 -0.0995202 -0.0189486 0.0147695 -0.0550758 0.0116389 0.0147682 -0.0550762 -0.0137554 0.0147687 -0.105434 0.0116397 0.0147674 -0.105434 -0.0137546 0.0103636 -0.105434 -0.0137543 0.0103644 -0.0550762 -0.0137551 0.010365 -0.105434 0.01164 0.0103657 -0.0550757 0.0116392 -0.0182104 -0.105434 -0.0137524 -0.0182096 -0.0550761 -0.0137532 -0.018209 -0.105434 0.0116419 -0.0182083 -0.0550757 0.0116411 0.0177641 -0.105434 -0.0137547 0.0177654 -0.105434 0.0116395 0.0177648 -0.0550763 -0.0137555 0.0177662 -0.0550758 0.0116388 -0.0268751 -0.104904 -0.0082243 0.0268672 -0.104906 -0.0082262 -0.0268748 -0.107659 -0.0007447 0.0268673 -0.107661 -0.0007465 -0.0268743 -0.105565 0.0070048 0.0268675 -0.105567 0.0070029 -0.0247106 -0.100248 0.0112414 0.0247044 -0.10025 0.0112397 -0.0207297 -0.0798423 0.0190452 0.0207254 -0.0798438 0.0190437 -0.02072 -0.0748139 0.0190452 0.0207161 -0.0748153 0.0190437 -0.0151325 -0.0748141 0.0256025 0.0151291 -0.0748151 0.0256014 -0.0151427 -0.0393888 0.0256025 0.0151418 -0.0393899 0.0256014 -0.0191718 -0.0383058 0.0220801 0.0191707 -0.0383071 0.0220788 -0.0200855 -0.0355728 0.0202953 0.0200845 -0.0355742 0.0202939 -0.0202365 -0.0210316 0.0199859 0.0202365 -0.021033 0.0199845 -0.0247056 0.0037197 0.0112427 0.0247067 0.0037179 0.011241 -0.0268703 0.0088198 0.0070048 0.0268714 0.0088179 0.0070029 -0.0268705 0.0119229 0.0021997 0.0268715 0.011921 0.0021978 -0.0268708 0.0117661 -0.0047306 0.0268713 0.0117642 -0.0047325 -0.0268712 0.0086299 -0.0101241 0.0268711 0.008628 -0.010126 -0.0268716 0.0032585 -0.0132302 0.0268709 0.0032566 -0.0132321 -0.0268735 -0.0529287 -0.0120951 0.0268689 -0.0529305 -0.012097 -0.0268744 -0.0686308 -0.0189057 0.0268683 -0.0686326 -0.0189075 -0.0268751 -0.0998458 -0.0124735 0.0268673 -0.0998477 -0.0124753 -1.7e-06 -0.0748146 0.0256017 -5e-07 -0.0393893 0.0256017 -0.0191731 -0.0748139 0.0220801 0.0191694 -0.0748153 0.0220788 -0.0182398 -0.074814 0.021043 0.0182361 -0.0748153 0.0210418 -5e-07 -0.0393893 0.0245647 -1.8e-06 -0.0748146 0.0245647 -0.0216722 -0.099846 -0.0125567 0.0216643 -0.0998475 -0.0125582 -0.0216714 -0.068631 -0.0189889 0.0216653 -0.0686325 -0.0189904 -0.0216705 -0.0529288 -0.0121783 0.021666 -0.0529304 -0.0121798 -0.0216686 0.0032583 -0.0133134 0.0216679 0.0032568 -0.0133149 -0.0216682 0.0086297 -0.0102073 0.0216681 0.0086282 -0.0102089 -0.0216679 0.0117659 -0.0048138 0.0216683 0.0117644 -0.0048153 -0.0216675 0.0119227 0.0021164 0.0216685 0.0119212 0.0021149 -0.0182386 -0.0383058 0.021043 0.0182373 -0.0383071 0.0210418 -0.0142095 -0.0393888 0.0245654 0.0142084 -0.0393898 0.0245644 -0.0141993 -0.0748141 0.0245654 0.0141958 -0.0748151 0.0245644 -0.0216718 -0.107659 -0.0008279 0.0216642 -0.107661 -0.0008294 -0.0216721 -0.104904 -0.0083076 0.0216642 -0.104906 -0.0083091 -0.0216713 -0.105565 0.0070045 0.0216645 -0.105567 0.007003 -0.0216673 0.0088196 0.0070045 0.0216684 0.0088181 0.007003 -0.0206426 -0.100248 0.0112412 0.0206364 -0.10025 0.0112397 -0.0187198 -0.074814 0.0190451 0.018716 -0.0748153 0.0190438 -0.0187634 -0.0798424 0.0190451 0.0187592 -0.0798437 0.0190438 -0.0184737 -0.0210316 0.0199858 0.0184737 -0.0210329 0.0199845 -0.0184244 -0.0355729 0.0202952 0.0184234 -0.0355742 0.0202939 -0.0206122 0.0037195 0.0112425 0.0206132 0.0037181 0.011241 ] } coordIndex [ 50 46 48 -1 47 51 49 -1 64 46 58 -1 47 65 59 -1 64 44 46 -1 45 65 47 -1 52 54 56 -1 55 53 57 -1 58 50 56 -1 51 59 57 -1 58 46 50 -1 47 59 51 -1 58 62 64 -1 63 59 65 -1 58 60 62 -1 61 59 63 -1 76 78 74 -1 79 77 75 -1 42 44 64 -1 45 43 65 -1 72 74 66 -1 75 73 67 -1 74 64 66 -1 65 75 67 -1 74 78 64 -1 79 75 65 -1 70 66 68 -1 67 71 69 -1 70 72 66 -1 73 71 67 -1 78 42 64 -1 43 79 65 -1 42 78 40 -1 79 43 41 -1 52 56 82 -1 57 53 83 -1 82 56 50 -1 57 83 51 -1 104 106 102 -1 107 105 103 -1 88 90 92 -1 91 89 93 -1 92 94 100 -1 95 93 101 -1 100 96 98 -1 97 101 99 -1 94 96 100 -1 97 95 101 -1 88 108 110 -1 109 89 111 -1 102 106 84 -1 107 103 85 -1 114 112 108 -1 109 113 115 -1 100 114 108 -1 109 115 101 -1 92 100 108 -1 109 101 93 -1 92 108 88 -1 89 109 93 -1 122 124 118 -1 119 125 123 -1 126 122 118 -1 119 123 127 -1 118 120 116 -1 117 121 119 -1 126 118 116 -1 117 119 127 -1 114 126 116 -1 117 127 115 -1 114 116 112 -1 113 117 115 -1 44 112 46 -1 113 45 47 -1 46 112 116 -1 113 47 117 -1 46 116 48 -1 117 47 49 -1 48 116 120 -1 117 49 121 -1 48 120 50 -1 121 49 51 -1 50 120 118 -1 121 51 119 -1 84 118 102 -1 119 85 103 -1 102 118 124 -1 119 103 125 -1 62 114 64 -1 115 63 65 -1 62 126 114 -1 127 63 115 -1 60 126 62 -1 127 61 63 -1 60 122 126 -1 123 61 127 -1 58 122 60 -1 123 59 61 -1 58 124 122 -1 125 59 123 -1 56 124 58 -1 125 57 59 -1 56 102 124 -1 103 57 125 -1 64 114 66 -1 115 65 67 -1 66 114 100 -1 115 67 101 -1 86 106 104 -1 107 86 105 -1 86 87 106 -1 87 86 107 -1 78 110 40 -1 111 79 41 -1 78 88 110 -1 89 79 111 -1 40 108 42 -1 109 41 43 -1 40 110 108 -1 111 41 109 -1 54 102 56 -1 103 55 57 -1 54 104 102 -1 105 55 103 -1 66 100 68 -1 101 67 69 -1 68 100 98 -1 101 69 99 -1 68 98 70 -1 99 69 71 -1 70 98 96 -1 99 71 97 -1 72 92 74 -1 93 73 75 -1 72 94 92 -1 95 73 93 -1 74 92 76 -1 93 75 77 -1 76 92 90 -1 93 77 91 -1 76 88 78 -1 89 77 79 -1 76 90 88 -1 91 77 89 -1 70 96 72 -1 97 71 73 -1 72 96 94 -1 97 73 95 -1 81 104 54 -1 105 81 55 -1 81 86 104 -1 86 81 105 -1 52 106 80 -1 107 53 80 -1 80 106 87 -1 107 80 87 -1 82 84 52 -1 85 83 53 -1 52 84 106 -1 85 53 107 -1 52 81 54 -1 81 53 55 -1 52 80 81 -1 80 53 81 -1 43 45 113 109 -1 42 108 112 44 -1 51 83 85 119 -1 50 118 84 82 -1 ] creaseAngle 0.2 } } Shape { appearance USE MOTOR_APPEARANCE geometry IndexedFaceSet { coord USE DLegUpperRCoord coordIndex [ 32 33 36 -1 33 38 36 -1 35 34 37 -1 35 37 39 -1 33 39 38 -1 33 35 39 -1 32 36 37 -1 32 37 34 -1 38 37 36 -1 38 39 37 -1 32 34 35 -1 32 35 33 -1 20 18 22 -1 20 16 18 -1 17 23 19 -1 17 21 23 -1 23 25 27 -1 23 21 25 -1 19 28 29 -1 19 29 17 -1 28 23 27 -1 28 19 23 -1 21 29 25 -1 21 17 29 -1 31 20 24 -1 31 16 20 -1 18 31 30 -1 18 16 31 -1 24 22 26 -1 24 20 22 -1 22 30 26 -1 22 18 30 -1 9 1 5 -1 9 13 1 -1 7 9 5 -1 7 11 9 -1 0 13 15 -1 0 1 13 -1 0 11 7 -1 0 15 11 -1 10 2 6 -1 10 14 2 -1 3 8 4 -1 3 12 8 -1 12 3 2 -1 12 2 14 -1 8 6 4 -1 8 10 6 -1 14 8 12 -1 14 10 8 -1 11 13 9 -1 11 15 13 -1 ] creaseAngle 0.2 } } ] } # LegLowerR %< if (enable_backlash) { >% DEF DLegLowerR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_leg_lower >% %< } else { >% DEF DLegLowerR HingeJoint { %< } >% device [ RotationalMotor { name "LegLowerR" acceleration 55 maxVelocity 12.26 minPosition -0.02 maxPosition 2.25 maxTorque 2.5 } PositionSensor { name "LegLowerRS" } ] jointParameters HingeJointParameters { axis 1 0 0 anchor -0 -0.093 0 position 2.25 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation -0 -0.093 0 rotation 1 0 0 2.25 children [ DEF DLegLowerRShape Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord Coordinate { point [ -0.0321993 -0.0784274 -0.0367567 0.0321848 -0.0784297 -0.036759 -0.0311065 -0.039214 -0.0368244 0.0310947 -0.0392162 -0.0368265 -0.0307739 -0.0273103 -0.0213664 0.030764 -0.0273124 -0.0213685 -0.0303676 -0.0127541 -0.0089623 0.0303596 -0.0127562 -0.0089644 -0.0299627 0.0017605 -0.0015366 0.0299562 0.0017584 -0.0015386 -0.0295524 0.0164661 0.0041364 0.0295473 0.0164641 0.0041343 -0.0295519 0.0164723 0.0132633 0.0295475 0.0164702 0.0132613 -0.0308119 -0.0287301 0.009323 0.030804 -0.0287322 0.0093209 -0.0317947 -0.0639797 0.0020636 0.0317838 -0.0639819 0.0020614 -0.0321936 -0.0782869 -0.0018773 0.0321815 -0.0782892 -0.0018795 -0.0245284 -0.104272 0.0042731 0.0245149 -0.104274 0.0042714 -0.0275971 -0.0999259 0.0088055 0.0275843 -0.0999278 0.0088036 -0.0313345 -0.0910052 0.0009336 0.0313218 -0.0910074 0.0009314 -0.0320669 -0.0852867 -0.001929 0.0320543 -0.085289 -0.0019313 -0.0245289 -0.104272 -0.0063462 0.0245147 -0.104274 -0.0063479 -0.0275982 -0.0999262 -0.0114828 0.0275839 -0.0999282 -0.0114847 -0.0313357 -0.0910056 -0.021763 0.0313214 -0.0910077 -0.0217652 -0.0320683 -0.0852872 -0.0283899 0.0320539 -0.0852894 -0.0283921 -4.3e-06 -0.0583238 0.0271951 -2.7e-06 -0.0147893 0.0307726 -1.6e-06 0.0164661 0.0312491 -0.0199881 -0.0583235 0.0271962 0.0199794 -0.0583249 0.0271948 -0.0199871 -0.0147889 0.0307736 0.0199818 -0.0147903 0.0307722 -0.0199866 0.0164664 0.0312502 0.0199834 0.016465 0.0312488 -0.0218916 -0.0583235 0.0245723 0.0218828 -0.058325 0.0245708 -0.0218923 -0.0862333 0.0205175 0.0218812 -0.0862348 0.020516 -0.0266784 0.0164694 0.0225978 0.0266747 0.0164675 0.0225959 -0.026354 -0.0217595 0.0218212 0.0263475 -0.0217613 0.0218193 -0.0265701 -0.0611515 0.0190455 0.0265607 -0.0611533 0.0190437 -0.0265918 -0.0822601 0.0142797 0.0265806 -0.0822619 0.0142779 -0.0288887 -0.0784275 -0.0367569 0.0288741 -0.0784295 -0.0367589 -0.0277958 -0.039214 -0.0368245 0.027784 -0.039216 -0.0368265 -0.0274632 -0.0273103 -0.0213665 0.0274534 -0.0273123 -0.0213684 -0.0270569 -0.0127542 -0.0089625 0.0270489 -0.012756 -0.0089644 -0.026652 0.0017605 -0.0015367 0.0266455 0.0017586 -0.0015386 -0.0262417 0.0164661 0.0041362 0.0262367 0.0164642 0.0041344 -0.0262412 0.0164722 0.0132632 0.0262368 0.0164704 0.0132613 -0.0212177 -0.104272 0.0042729 0.0212042 -0.104274 0.0042714 -0.0242864 -0.0999259 0.0088053 0.0242736 -0.0999276 0.0088036 -0.0212182 -0.104272 -0.0063464 0.021204 -0.104274 -0.0063479 -0.0242875 -0.0999263 -0.011483 0.0242732 -0.099928 -0.0114847 -0.0280251 -0.0910056 -0.0217631 0.0280107 -0.0910076 -0.0217651 -0.0287576 -0.0852873 -0.0283901 0.0287432 -0.0852893 -0.0283921 -0.0176031 -0.0583235 0.0248109 0.0175943 -0.0583248 0.0248097 -0.0176016 0.0164664 0.0288649 0.0175982 0.0164651 0.0288637 -0.0195066 -0.0583235 0.022187 0.0194976 -0.0583249 0.0221857 -0.0195073 -0.0862334 0.0181323 0.019496 -0.0862347 0.0181309 -0.0242934 0.0164693 0.0202125 0.0242895 0.0164676 0.0202108 -4.4e-06 -0.0583238 0.0243141 -1.7e-06 0.016466 0.0283681 ] } coordIndex [ 10 14 12 -1 15 11 13 -1 10 16 14 -1 17 11 15 -1 8 16 10 -1 17 9 11 -1 8 18 16 -1 19 9 17 -1 6 18 8 -1 19 7 9 -1 6 0 18 -1 7 19 1 -1 4 0 6 -1 5 7 1 -1 2 0 4 -1 3 5 1 -1 30 20 22 -1 21 31 23 -1 24 30 22 -1 31 25 23 -1 30 28 20 -1 29 31 21 -1 32 30 24 -1 31 33 25 -1 26 32 24 -1 33 27 25 -1 0 26 18 -1 27 1 19 -1 34 32 26 -1 33 35 27 -1 0 34 26 -1 35 1 27 -1 55 24 22 -1 25 56 23 -1 26 55 18 -1 56 27 19 -1 26 24 55 -1 25 27 56 -1 22 47 55 -1 48 23 56 -1 45 53 55 47 -1 56 54 46 48 -1 16 18 55 53 -1 56 19 17 54 -1 45 51 53 -1 52 46 54 -1 14 16 53 51 -1 54 17 15 52 -1 12 14 51 49 -1 52 15 13 50 -1 39 41 45 -1 42 40 46 -1 41 51 45 -1 52 42 46 -1 41 43 49 51 -1 50 44 42 52 -1 36 37 41 39 -1 42 37 36 40 -1 37 38 43 41 -1 44 38 37 42 -1 12 49 91 69 -1 92 50 13 70 -1 10 12 69 67 -1 70 13 11 68 -1 8 10 67 65 -1 68 11 9 66 -1 6 8 65 63 -1 66 9 7 64 -1 4 6 63 61 -1 64 7 5 62 -1 43 85 91 49 -1 92 86 44 50 -1 2 4 61 59 -1 62 5 3 60 -1 0 2 59 57 -1 60 3 1 58 -1 0 57 81 34 -1 82 58 1 35 -1 32 34 81 79 -1 82 35 33 80 -1 30 32 79 77 -1 80 33 31 78 -1 28 30 77 75 -1 78 31 29 76 -1 20 28 75 71 -1 76 29 21 72 -1 20 71 73 22 -1 74 72 21 23 -1 22 73 89 47 -1 90 74 23 48 -1 45 47 89 87 -1 90 48 46 88 -1 39 45 87 83 -1 88 46 40 84 -1 38 94 85 43 -1 86 94 38 44 -1 36 39 83 93 -1 84 40 36 93 -1 83 85 94 93 -1 94 86 84 93 -1 83 87 91 85 -1 92 88 84 86 -1 87 89 91 -1 90 88 92 -1 73 91 89 -1 92 74 90 -1 69 91 73 -1 92 70 74 -1 69 73 71 -1 74 70 72 -1 69 71 75 -1 72 70 76 -1 79 69 75 -1 70 80 76 -1 81 69 79 -1 70 82 80 -1 57 69 81 -1 70 58 82 -1 79 75 77 -1 76 80 78 -1 63 65 57 -1 66 64 58 -1 61 63 57 -1 64 62 58 -1 59 61 57 -1 62 60 58 -1 57 65 69 -1 66 58 70 -1 65 67 69 -1 68 66 70 -1 ] creaseAngle 0.2 } } # AnkleR %< if (enable_backlash) { >% DEF DAnkleR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_ankle >% %< } else { >% DEF DAnkleR HingeJoint { %< } >% device [ RotationalMotor { name "AnkleR" acceleration 55 maxVelocity 12.26 minPosition -1.24 maxPosition 1.38 maxTorque 2.5 } PositionSensor { name "AnkleRS" } ] jointParameters HingeJointParameters { axis -1 0 0 anchor 0 -0.093 0 position 1.22 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 -0.093 0 rotation -1 0 0 1.22 children [ DEF DAnkleRShape Shape { appearance USE MOTOR_APPEARANCE geometry IndexedFaceSet { coord Coordinate { point [ -0.0180496 -0.0121957 0.0214751 -0.0180517 -0.0122 -0.0191605 0.0175659 -0.0122 -0.0191618 0.017568 -0.0121957 0.0214738 -0.0180515 0.0384664 -0.014134 0.0175662 0.0384664 -0.0141352 0.0175655 0.0268706 -0.026837 0.0175637 0.0268669 -0.0618523 -0.018054 0.0268669 -0.0618505 -0.0180521 0.0268706 -0.0268352 0.0175655 -0.006374 -0.0268336 0.0175637 -0.0063777 -0.0618488 -0.018054 -0.0063777 -0.061847 -0.0180521 -0.006374 -0.0268317 -0.0180496 0.0122084 0.0214725 0.017568 0.0122084 0.0214713 0.0175678 0.012208 0.0173237 -0.0180498 0.0122079 0.017325 -0.0155939 0.0384664 -0.0141339 0.0151016 0.0384664 -0.0141353 0.0151018 0.012208 0.0173236 -0.0155936 0.0122079 0.017325 0.0151015 0.0122073 0.0113889 -0.0155939 0.0122073 0.0113905 -0.0155939 0.0324518 0.0113884 0.0151015 0.0324518 0.0113868 0.0150999 0.0324486 -0.0190557 -0.0155955 0.0324487 -0.0190543 -0.0180517 0.0324486 -0.0190541 0.0175659 0.0324486 -0.0190558 -0.0155936 0.0324524 0.0173229 -0.0180498 0.0324524 0.0173228 0.0175678 0.0324525 0.0173216 0.0151018 0.0324525 0.0173215 -0.0180501 0.0384691 0.0113879 -0.0155937 0.0384691 0.0113878 0.0151018 0.0384691 0.0113862 0.0175675 0.0384691 0.011386 0.0175653 0.0268703 -0.0296628 0.0175638 0.0268672 -0.0590257 -0.0180538 0.0268672 -0.0590239 -0.0180523 0.0268703 -0.029661 0.0175653 -0.0063743 -0.0296594 0.0175638 -0.0063774 -0.0590223 -0.0180538 -0.0063774 -0.0590204 -0.0180523 -0.0063743 -0.0296575 0.0125344 0.032694 -0.0590261 0.0125359 0.032697 -0.0296632 -0.0128584 0.032697 -0.0296619 -0.0128599 0.0326939 -0.0590248 0.0125344 -0.0122042 -0.0590214 0.0125359 -0.0122011 -0.0296585 -0.0128584 -0.0122011 -0.0296572 -0.0128599 -0.0122042 -0.05902 -0.01286 -0.0122045 -0.0618466 -0.0128582 -0.0122008 -0.0268314 -0.01286 0.0326937 -0.0618513 -0.0128582 0.0326973 -0.0268361 0.0125342 -0.0122044 -0.061848 0.0125342 0.0326937 -0.0618527 0.0125361 0.0326973 -0.0268374 0.0125361 -0.0122008 -0.0268327 0.0097484 0.00878 -0.0157665 0.0097476 0.0087784 -0.0307529 0.0097476 0.0147392 -0.0307535 0.0097484 0.0147408 -0.0157672 -0.0100694 0.0087799 -0.0157655 -0.0100702 0.0087784 -0.0307519 -0.0100702 0.0147392 -0.0307525 -0.0100694 0.0147407 -0.0157661 -0.0100694 0.0318251 -0.0157679 -0.0100702 0.0318235 -0.0307543 -0.0100702 0.0258627 -0.0307536 -0.0100694 0.0258643 -0.0157673 0.0097485 0.0318251 -0.0157689 0.0097477 0.0318236 -0.0307553 0.0097477 0.0258628 -0.0307547 0.0097484 0.0258644 -0.0157683 ] } coordIndex [ 0 14 1 -1 15 3 2 -1 1 14 17 -1 2 16 15 -1 16 20 15 -1 21 17 14 -1 22 33 25 -1 27 35 24 -1 5 26 19 -1 4 18 27 -1 4 27 28 -1 1 28 27 -1 1 17 28 -1 5 29 26 -1 2 26 29 -1 2 29 16 -1 33 36 25 -1 35 30 24 -1 33 22 20 -1 35 27 18 -1 31 28 17 -1 37 29 5 -1 75 74 77 -1 75 77 76 -1 73 70 71 -1 73 71 72 -1 77 73 72 -1 77 72 76 -1 75 71 70 -1 75 70 74 -1 64 68 69 -1 64 69 65 -1 62 66 67 -1 62 67 63 -1 66 69 68 -1 66 68 67 -1 64 65 62 -1 64 62 63 -1 46 47 51 -1 46 51 50 -1 56 46 59 -1 56 49 46 -1 46 48 47 -1 46 49 48 -1 47 48 57 -1 47 57 60 -1 55 51 61 -1 55 52 51 -1 54 58 50 -1 54 50 53 -1 50 52 53 -1 50 51 52 -1 38 42 51 -1 38 51 47 -1 6 38 47 -1 6 47 60 -1 6 60 61 -1 6 61 10 -1 10 61 51 -1 10 51 42 -1 11 43 50 -1 11 50 58 -1 39 46 50 -1 39 50 43 -1 7 11 58 -1 7 58 59 -1 7 59 46 -1 7 46 39 -1 9 57 48 -1 9 48 41 -1 9 13 55 -1 9 55 57 -1 13 45 52 -1 13 52 55 -1 8 40 49 -1 8 49 56 -1 12 54 53 -1 12 53 44 -1 8 54 12 -1 8 56 54 -1 40 44 53 -1 40 53 49 -1 55 60 57 -1 55 61 60 -1 56 58 54 -1 56 59 58 -1 48 53 52 -1 48 49 53 -1 40 8 12 -1 40 12 44 -1 9 41 45 -1 9 45 13 -1 38 6 10 -1 38 10 42 -1 7 39 43 -1 7 43 11 -1 36 33 32 -1 36 32 37 -1 30 35 34 -1 30 34 31 -1 29 37 16 -1 37 32 16 -1 28 31 34 -1 28 34 4 -1 1 27 26 -1 1 26 2 -1 26 25 19 -1 25 36 19 -1 24 25 26 -1 24 26 27 -1 23 24 30 -1 23 30 21 -1 23 22 25 -1 23 25 24 -1 14 15 20 -1 14 20 21 -1 20 22 23 -1 20 23 21 -1 36 37 5 -1 36 5 19 -1 34 35 18 -1 34 18 4 -1 32 33 20 -1 32 20 16 -1 30 31 17 -1 30 17 21 -1 14 0 3 -1 14 3 15 -1 0 1 2 -1 0 2 3 -1 41 48 52 45 -1 ] creaseAngle 0.2 } } # FootR %< if (enable_backlash) { >% DEF DFootR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_foot >% %< } else { >% DEF DFootR HingeJoint { %< } >% device [ RotationalMotor { name "FootR" acceleration 55 maxVelocity 12.26 minPosition -0.68 maxPosition 1.04 maxTorque 2.5 } PositionSensor { name "FootRS" } ] jointParameters HingeJointParameters { axis 0 0 1 position 0.05 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { rotation 0 0 1 0.05 children [ DEF RIGHT_FOOT_SLOT Group { children IS rightFootSlot } DEF DFootRShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DFootRCoord Coordinate { point [ 0.0087351 0.0067732 0.024694 0.0087339 -0.0101191 0.0246957 0.0002876 -0.013617 0.024697 -0.0081583 -0.0101179 0.0246975 -0.0116562 -0.0016371 0.024697 -0.0081571 0.0067743 0.0246957 0.0002892 0.0102722 0.0246945 0.0087349 0.0067729 0.0225302 0.0122328 -0.0016389 0.0225307 0.0087337 -0.0101193 0.0225319 0.0002873 -0.0136172 0.0225332 -0.0081585 -0.0101181 0.0225337 -0.0116564 -0.0016373 0.0225332 -0.0081573 0.0067741 0.0225319 0.000289 0.010272 0.0225307 0.0002839 0.0102669 -0.0258946 -0.0081624 0.006769 -0.0258933 -0.0116615 -0.0016423 -0.0258921 -0.0081636 -0.0101232 -0.0258915 0.0002823 -0.0136223 -0.0258921 0.0087286 -0.0101244 -0.0258933 0.0122277 -0.001644 -0.0258946 0.0087298 0.0067679 -0.0258951 0.0002841 0.0102672 -0.0238477 -0.0081622 0.0067692 -0.0238464 -0.0116613 -0.0016421 -0.0238452 -0.0081634 -0.010123 -0.0238447 0.0002825 -0.013622 -0.0238452 0.0087288 -0.0101241 -0.0238464 0.00873 0.0067681 -0.0238482 -0.010548 -0.0309107 0.0262602 -0.0105533 -0.0309159 -0.0238421 0.0112581 -0.0309122 0.0262579 0.0112529 -0.0309175 -0.0238444 0.0112531 -0.0295256 -0.0223182 0.011258 -0.0295206 0.0246976 -0.0105481 -0.0295191 0.0246999 -0.010553 -0.029524 -0.0223159 -0.010551 -0.0016421 -0.022319 -0.0105461 -0.0016371 0.0246969 0.01126 -0.0016387 0.0246946 0.0112551 -0.0016436 -0.0223213 0.011255 -0.0016437 -0.0238476 0.0112602 -0.0016385 0.0262548 -0.0105459 -0.001637 0.026257 -0.0105512 -0.0016422 -0.0238453 0.0032596 0.0013023 -0.0264139 0.0044923 -0.001655 -0.0264137 0.0032592 -0.0046505 -0.0264133 0.0002828 -0.0058832 -0.0264129 -0.0026936 -0.0046501 -0.0264127 -0.0039262 -0.0016544 -0.0264129 -0.0026931 0.0013027 -0.0264133 0.0002833 0.0025353 -0.0264137 0.0002889 0.0025409 0.0266982 -0.0026876 0.0013083 0.0266987 -0.0039207 -0.0016488 0.0266991 -0.002688 -0.0046445 0.0266993 0.0002883 -0.0058776 0.0266991 0.0032648 -0.0046449 0.0266987 0.0044979 -0.0016494 0.0266982 0.0032652 0.0013078 0.0266981 0.0221498 -0.018297 -0.0532336 -0.0440127 -0.0182935 -0.053229 -0.0440135 -0.0335076 -0.0532282 0.022149 -0.033551 -0.0532328 0.0145385 -0.0335451 0.0507267 -0.0376582 -0.0335025 0.0503676 -0.0376577 -0.0238965 0.050367 0.014539 -0.0238992 0.0507262 0.022155 -0.0182931 0.0211808 -0.0440075 -0.0182896 0.0211854 0.0075687 -0.0335447 0.0521782 -0.0298333 -0.0335427 0.0521808 -0.0298328 -0.0238968 0.0521803 0.0075692 -0.0238988 0.0521776 0.0221564 -0.0226617 0.0447678 -0.0440061 -0.0226583 0.0447724 0.0221558 -0.0335059 0.0447683 -0.0440067 -0.0335025 0.044773 ] } coordIndex [ 76 70 66 -1 71 77 67 -1 70 75 76 -1 76 75 69 -1 68 74 77 -1 77 74 71 -1 67 79 73 -1 64 73 79 -1 64 79 77 -1 63 64 77 -1 63 77 71 -1 62 70 76 -1 65 78 72 -1 66 72 78 -1 62 76 65 -1 76 78 65 -1 66 78 69 -1 78 76 69 -1 67 68 79 -1 68 77 79 -1 75 70 71 -1 75 71 74 -1 75 72 66 -1 75 66 69 -1 74 73 72 -1 74 72 75 -1 68 67 74 -1 67 73 74 -1 73 64 72 -1 64 65 72 -1 62 63 71 -1 62 71 70 -1 62 65 64 -1 62 64 63 -1 ] creaseAngle 0.2 } } Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord USE DFootRCoord coordIndex [ 1 3 2 -1 40 3 1 -1 40 4 3 -1 0 4 40 -1 0 5 4 -1 0 6 5 -1 9 10 11 -1 9 11 12 -1 8 9 12 -1 7 8 12 -1 7 12 13 -1 14 7 13 -1 28 26 27 -1 42 26 28 -1 42 25 26 -1 29 25 42 -1 29 24 25 -1 29 23 24 -1 20 19 18 -1 20 18 17 -1 21 20 17 -1 22 21 17 -1 22 17 16 -1 15 22 16 -1 53 46 52 -1 46 51 52 -1 46 47 51 -1 47 48 51 -1 48 50 51 -1 48 49 50 -1 55 61 54 -1 55 56 61 -1 56 60 61 -1 56 59 60 -1 56 57 59 -1 57 58 59 -1 47 46 61 -1 47 61 60 -1 48 47 60 -1 48 60 59 -1 49 48 59 -1 49 59 58 -1 50 49 58 -1 50 58 57 -1 51 50 57 -1 51 57 56 -1 52 51 56 -1 52 56 55 -1 53 52 55 -1 53 55 54 -1 46 53 54 -1 46 54 61 -1 38 37 34 -1 38 34 41 -1 36 39 40 -1 36 40 35 -1 42 45 38 -1 42 38 41 -1 44 43 40 -1 44 40 39 -1 33 31 45 -1 33 45 42 -1 30 32 43 -1 30 43 44 -1 34 33 42 -1 34 42 41 -1 32 35 43 -1 35 40 43 -1 36 30 44 -1 36 44 39 -1 31 37 45 -1 37 38 45 -1 29 21 22 -1 29 42 21 -1 42 20 21 -1 42 28 20 -1 28 19 20 -1 28 27 19 -1 27 18 19 -1 27 26 18 -1 26 17 18 -1 26 25 17 -1 25 16 17 -1 25 24 16 -1 24 15 16 -1 24 23 15 -1 23 22 15 -1 23 29 22 -1 6 0 7 -1 7 14 6 -1 5 14 13 -1 5 6 14 -1 4 13 12 -1 4 5 13 -1 3 12 11 -1 3 4 12 -1 2 11 10 -1 2 3 11 -1 1 10 9 -1 1 2 10 -1 40 9 8 -1 40 1 9 -1 0 8 7 -1 0 40 8 -1 ] creaseAngle 0.2 } } ] } ] boundingObject Pose { translation -0.011 -0.027 -0.001 children [ Box { size 0.066 0.013 0.105 } ] } physics Physics { density -1 mass 0.0794462 centerOfMass [ -0.00950588 -0.0259953 -0.000502877 ] inertiaMatrix [ 6.8325629e-05 8.7890505e-05 3.5840758e-05 -2.5330463e-06 -2.1869558e-07 9.7620541e-07 ] } } } ] boundingObject Pose { translation 0 0.01 -0.0205 children [ Box { size 0.036 0.045 0.083 } ] } physics Physics { density -1 mass 0.167108 centerOfMass [ 0.000213732 0.0138731 -0.0185361 ] inertiaMatrix [ 1.2079175e-04 1.0885465e-04 4.1871103e-05 7.9781067e-07 3.9322246e-07 7.0770117e-06 ] } } } ] boundingObject Group { children [ Pose { translation 0 -0.058 -0.001 children [ Box { size 0.064 0.034 0.041 } ] } Pose { translation 0 -0.02 0.016 rotation 1 0 0 0.04 children [ Box { size 0.062 0.073 0.027 } ] } ] } physics Physics { density -1 mass 0.0703098 centerOfMass [ 0.000592469 -0.0539545 0.00654763 ] inertiaMatrix [ 9.3369608e-05 4.6295534e-05 1.1351516e-04 9.3567395e-07 2.3992085e-07 -1.2858493e-05 ] } } } ] boundingObject Pose { translation 0 -0.058 0.006 children [ Box { size 0.053 0.035 0.042 } ] } physics Physics { density -1 mass 0.119043 centerOfMass [ 0.000322635 -0.0629655 0.000691906 ] inertiaMatrix [ 9.7950272e-05 3.2848287e-05 1.1493509e-04 -1.2119368e-06 2.1223016e-07 -1.9474021e-06 ] } } } ] boundingObject Pose { translation 0 -0.0105 -0.023 children [ Box { size 0.036 0.043 0.077 } ] } physics Physics { density -1 mass 0.167108 centerOfMass [ -7.99828e-05 -0.0138731 -0.0182424 ] inertiaMatrix [ 1.2259691e-04 1.1066637e-04 4.1877668e-05 -7.1127469e-07 -8.1143913e-07 -7.1635476e-06 ] } } } ] name "pelvYR" boundingObject Pose { translation 0 0.017 0.001 children [ Box { size 0.022 0.028 0.05 } ] } physics Physics { density -1 mass 0.0270692 centerOfMass [ 0.00048 -0.0 0.01844 ] inertiaMatrix [ 1.5019148e-05 1.1328768e-05 6.1825529e-06 -0.0000000e+00 -0.0000000e+00 -7.3350016e-07 ] } } } # ShoulderL %< if (enable_backlash) { >% DEF DShoulderL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_shoulder >% %< } else { >% DEF DShoulderL HingeJoint { %< } >% device [ RotationalMotor { name "ShoulderL" acceleration 55 maxVelocity 12.26 minPosition -3.14 maxPosition 2.85 maxTorque 2.5 } PositionSensor { name "ShoulderLS" } ] jointParameters HingeJointParameters { axis 0 1 0 anchor -0.0 0.082 0.0 position 0.72 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 0.082 0 rotation 0.6734 0.6734 0.3051 2.5494 children [ DEF DShoulderLShape Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord Coordinate { point [ 0.0025152 -0.0272838 -0.0201519 -0.0063963 -0.0253913 -0.020152 -0.011394 -0.0176984 -0.0201521 -0.009482 -0.0087585 -0.0201522 -0.0018086 -0.0037891 -0.0201522 0.0071596 -0.0057208 -0.0201521 0.0121006 -0.0133746 -0.020152 0.0101886 -0.0223144 -0.0201519 0.0025152 -0.0272838 -0.017988 -0.0063963 -0.0253913 -0.0179881 -0.011394 -0.0176983 -0.0179883 -0.009482 -0.0087585 -0.0179884 -0.0018086 -0.0037891 -0.0179884 0.0071596 -0.0057207 -0.0179883 0.0121006 -0.0133746 -0.0179882 0.0101886 -0.0223144 -0.0179881 -0.0236502 0.0108478 -0.0217128 -0.0236213 -0.0109584 -0.0217124 -0.0221549 -0.0109583 -0.0201523 -0.0222586 0.0108478 -0.0201526 0.0084534 -0.0082007 -0.0201521 -0.0075397 -0.0234598 -0.020152 -0.0075397 -0.0234599 -0.0217122 0.0084534 -0.0082007 -0.0217123 -0.0256226 1.39e-05 0.0113823 -0.0256226 0.0080327 0.0080607 -0.0256224 0.011354 4.18e-05 -0.0256223 0.0080324 -0.007977 -0.0256222 1.35e-05 -0.0112984 -0.0256223 -0.0080052 -0.0079767 -0.0256224 -0.0113266 4.22e-05 -0.0256226 -0.008005 0.0080609 -0.0235638 1.39e-05 0.0113823 -0.0235638 0.0080327 0.0080607 -0.0235636 0.011354 4.18e-05 -0.0235635 0.0080324 -0.007977 -0.0235634 1.35e-05 -0.0112983 -0.0235635 -0.0080052 -0.0079767 -0.0236216 -0.0113266 4.22e-05 -0.0235638 -0.008005 0.008061 0.0038224 -0.0179272 -0.0221549 0.0044962 -0.0147768 -0.022155 0.0027608 -0.0120837 -0.022155 -0.0004054 -0.0113989 -0.0221551 -0.0031095 -0.0131501 -0.0221551 -0.0037833 -0.0163005 -0.022155 -0.0020162 -0.0190155 -0.022155 0.0011183 -0.0196784 -0.0221549 0.0011175 -0.0196784 0.0221863 -0.002017 -0.0190155 0.0221863 -0.0037841 -0.0163005 0.0221862 -0.0031103 -0.0131501 0.0221863 -0.0004062 -0.0113989 0.0221864 0.0027601 -0.0120837 0.0221865 0.0044954 -0.0147768 0.0221865 0.0038216 -0.0179272 0.0221864 0.0084526 -0.0082007 0.0217439 -0.0075404 -0.0234599 0.0217433 -0.0075404 -0.0234598 0.0201831 0.0084527 -0.0082007 0.0201838 -0.0222593 0.0108478 0.0201832 -0.0221556 -0.0109583 0.0201828 -0.023622 -0.0109584 0.021743 -0.023651 0.0108478 0.0217434 0.0101879 -0.0223144 0.0180198 0.0121 -0.0133746 0.01802 0.007159 -0.0057207 0.0180199 -0.0018092 -0.0037891 0.0180197 -0.0094826 -0.0087585 0.0180194 -0.0113947 -0.0176983 0.0180193 -0.0063969 -0.0253913 0.0180193 0.0025145 -0.0272838 0.0180195 0.0101879 -0.0223144 0.0201836 0.0120999 -0.0133746 0.0201838 0.0071589 -0.0057208 0.0201838 -0.0018093 -0.0037891 0.0201835 -0.0094827 -0.0087585 0.0201833 -0.0113947 -0.0176984 0.0201831 -0.006397 -0.0253913 0.0201831 0.0025145 -0.0272838 0.0201833 -0.0202183 -0.0109583 -0.0201522 -0.0202183 -0.0109584 -0.0217124 -0.020219 -0.0109584 0.021743 -0.020219 -0.0109583 0.0201829 -0.0112371 0.0108478 -0.0201524 -0.011237 0.0108478 -0.0217126 -0.0112378 0.0108478 0.0217436 -0.0112378 0.0108478 0.0201834 ] } coordIndex [ 10 12 11 -1 15 14 8 -1 24 25 31 -1 29 27 28 -1 41 40 47 -1 43 45 44 -1 52 51 50 -1 54 48 55 -1 64 71 65 -1 69 68 67 -1 21 19 80 -1 80 19 18 -1 17 16 81 -1 81 16 22 -1 62 82 63 -1 82 57 63 -1 58 83 60 -1 83 61 60 -1 19 21 84 -1 84 21 20 -1 23 22 85 -1 85 22 16 -1 56 86 57 -1 86 63 57 -1 60 87 58 -1 87 59 58 -1 87 60 86 -1 60 63 86 -1 59 87 86 -1 59 86 56 -1 85 20 23 -1 85 84 20 -1 16 19 85 -1 85 19 84 -1 82 62 61 -1 82 61 83 -1 57 82 83 -1 57 83 58 -1 80 22 21 -1 80 81 22 -1 18 81 80 -1 18 17 81 -1 78 75 77 -1 77 75 76 -1 79 75 78 -1 79 74 75 -1 72 74 79 -1 72 73 74 -1 70 69 67 -1 70 67 66 -1 65 71 70 -1 65 70 66 -1 49 48 54 -1 49 54 53 -1 52 50 49 -1 52 49 53 -1 59 56 57 -1 59 57 58 -1 64 79 71 -1 64 72 79 -1 72 65 73 -1 72 64 65 -1 73 66 74 -1 73 65 66 -1 74 67 75 -1 74 66 67 -1 75 68 76 -1 75 67 68 -1 76 69 77 -1 76 68 69 -1 77 70 78 -1 77 69 70 -1 78 71 79 -1 78 70 71 -1 1 0 8 -1 1 8 9 -1 9 10 2 -1 9 2 1 -1 10 11 3 -1 10 3 2 -1 11 12 4 -1 11 4 3 -1 12 13 5 -1 12 5 4 -1 13 14 6 -1 13 6 5 -1 14 15 7 -1 14 7 6 -1 0 7 15 -1 0 15 8 -1 22 20 21 -1 22 23 20 -1 39 32 24 -1 39 24 31 -1 25 24 32 -1 25 32 33 -1 26 25 33 -1 26 33 34 -1 27 26 34 -1 27 34 35 -1 28 27 35 -1 28 35 36 -1 29 28 36 -1 29 36 37 -1 30 29 38 -1 29 37 38 -1 31 30 38 -1 31 38 39 -1 46 43 42 -1 46 45 43 -1 41 46 42 -1 41 47 46 -1 30 27 29 -1 30 26 27 -1 25 30 31 -1 25 26 30 -1 9 14 13 -1 9 8 14 -1 12 9 13 -1 12 10 9 -1 7 0 5 -1 7 5 6 -1 0 1 4 -1 0 4 5 -1 3 4 2 -1 4 1 2 -1 42 43 52 -1 42 52 53 -1 43 44 51 -1 43 51 52 -1 44 45 50 -1 44 50 51 -1 45 46 49 -1 45 49 50 -1 46 47 48 -1 46 48 49 -1 40 55 48 -1 40 48 47 -1 40 41 54 -1 40 54 55 -1 41 42 53 -1 41 53 54 -1 17 18 61 -1 17 61 62 -1 16 63 60 -1 16 60 19 -1 18 19 60 -1 18 60 61 -1 16 17 62 -1 16 62 63 -1 ] creaseAngle 0.2 } } # ArmUpperL %< if (enable_backlash) { >% DEF DArmUpperL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_arm_upper >% %< } else { >% DEF DArmUpperL HingeJoint { %< } >% device [ RotationalMotor { name "ArmUpperL" acceleration 55 maxVelocity 12.26 minPosition -2.25 maxPosition 0.77 maxTorque 2.5 } PositionSensor { name "ArmUpperLS" } ] jointParameters HingeJointParameters { axis 0 0 -1 anchor 0 -0.016 0 position 0.36 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 -0.016 0 rotation 0 0 -1 -0.4254 children [ DEF DArmUpperLShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DArmUpperLCoord Coordinate { point [ -0.0156142 -0.0115128 -0.0201609 -0.0156147 -0.0373784 -0.0201613 -0.0116718 -0.0403751 -0.0201614 0.0161002 -0.0403756 -0.0201614 0.0041005 -0.0116708 -0.0201609 0.0089898 -0.0072548 -0.0201608 0.0091477 0.004574 -0.0201606 0.0064666 0.0080438 -0.0201605 -0.0058354 0.0080441 -0.0201605 -0.005993 0.0146682 -0.0201604 0.0102519 0.0130908 -0.0201605 0.0148394 0.0107249 -0.0201605 0.016101 0.0073237 -0.0201606 -0.0156142 -0.0115135 0.0198856 -0.0156147 -0.0373791 0.0198852 -0.0116718 -0.0403758 0.0198851 0.0161002 -0.0403763 0.0198851 0.0041005 -0.0116715 0.0198856 0.0089898 -0.0072555 0.0198857 0.0091477 0.0045733 0.0198859 0.0064666 0.0080432 0.019886 -0.0058354 0.0080434 0.019886 -0.005993 0.0146675 0.0198861 0.0102519 0.0130901 0.0198861 0.0148394 0.0107242 0.019886 0.016101 0.007323 0.019886 0.0161002 -0.0403759 -0.0001381 0.0201096 -0.0119169 -0.0121516 0.0210096 -0.0162368 -0.0041424 0.0210096 -0.0162369 0.0038669 0.0201096 -0.0119173 0.0118763 0.020109 -0.0454281 -0.0121522 0.0210091 -0.0480784 -0.0041429 0.0210091 -0.0480785 0.0038664 0.020109 -0.0454285 0.0118757 0.015025 -0.0472413 -0.0225059 0.0150258 -0.0472414 0.0278522 0.0150241 -0.0726356 -0.0225059 0.0150249 -0.0726357 0.0278522 0.0106211 -0.0726355 0.0278523 0.010622 -0.0472412 0.0278522 0.0106203 -0.0726354 -0.0225058 0.0106212 -0.0472412 -0.0225058 0.0106208 -0.0778295 0.0219381 0.0106221 -0.0422118 0.0219381 0.0106202 -0.0778294 -0.0165917 0.0106215 -0.0422117 -0.0165917 0.0150246 -0.0778296 0.0219381 0.0150258 -0.042212 0.021938 0.015024 -0.0778295 -0.0165917 0.0150252 -0.0422119 -0.0165917 -0.0102096 -0.0422114 -0.0165917 -0.0102108 -0.0778291 -0.0165917 -0.010209 -0.0422115 0.0219381 -0.0102102 -0.0778292 0.0219381 -0.0146133 -0.0422113 -0.0165917 -0.0146146 -0.0778289 -0.0165917 -0.0146128 -0.0422114 0.0219381 -0.014614 -0.077829 0.0219381 -0.0146136 -0.0472407 -0.0225058 -0.0146145 -0.072635 -0.0225058 -0.0146128 -0.0472408 0.0278522 -0.0146137 -0.0726351 0.0278523 -0.0102099 -0.0726352 0.0278522 -0.0102107 -0.0726351 -0.0225059 -0.0102091 -0.0472409 0.0278522 -0.0102098 -0.0472408 -0.0225059 0.0183641 -0.0726358 0.0278522 0.0183633 -0.0726357 -0.0225059 0.018365 -0.0472415 0.0278521 0.0183642 -0.0472414 -0.0225059 -0.0176104 -0.072635 0.0278523 -0.0176095 -0.0472407 0.0278523 -0.0176112 -0.0726349 -0.0225057 -0.0176103 -0.0472406 -0.0225058 -0.0124886 0.0116459 -0.018096 0.0129057 0.011645 -0.0180965 -0.0124903 -0.0387122 -0.0180961 0.012904 -0.038713 -0.0180966 -0.0124884 0.0116454 0.0178784 -0.0124901 -0.0387126 0.0178783 0.0129058 0.0116445 0.0178779 0.0129042 -0.0387135 0.0178778 -0.0124885 0.0116459 -0.0106956 -0.0124902 -0.0387122 -0.0106957 0.0129058 0.011645 -0.0106961 0.0129041 -0.0387131 -0.0106962 0.0129041 -0.0387131 -0.0150999 -0.0124902 -0.0387122 -0.0150995 0.0129057 0.011645 -0.0150998 -0.0124885 0.0116459 -0.0150994 0.0180982 -0.0327991 -0.0151 -0.0175194 -0.0327978 -0.0150994 0.0180995 0.0057307 -0.0150999 -0.0175182 0.0057319 -0.0150993 0.0180983 -0.0327991 -0.0106963 -0.0175194 -0.0327979 -0.0106956 0.0180995 0.0057306 -0.0106962 -0.0175181 0.0057319 -0.0106955 -0.0175181 0.0057314 0.0145393 0.0180995 0.0057302 0.0145386 -0.0175194 -0.0327983 0.0145392 0.0180983 -0.0327996 0.0145385 -0.0175182 0.0057315 0.0101355 0.0180995 0.0057302 0.0101349 -0.0175194 -0.0327983 0.0101354 0.0180982 -0.0327995 0.0101348 -0.0124885 0.0116454 0.0101354 0.0129057 0.0116446 0.010135 -0.0124902 -0.0387126 0.0101353 0.0129041 -0.0387135 0.0101349 0.0129041 -0.0387135 0.0145386 0.0129058 0.0116445 0.0145387 -0.0124902 -0.0387126 0.0145391 -0.0124885 0.0116454 0.0145392 ] } coordIndex [ 3 11 12 -1 5 11 3 -1 2 5 3 -1 5 10 11 -1 7 9 10 -1 6 7 10 -1 5 6 10 -1 2 4 5 -1 8 9 7 -1 2 0 4 -1 1 0 2 -1 16 25 24 -1 18 16 24 -1 15 16 18 -1 18 24 23 -1 20 23 22 -1 19 23 20 -1 18 23 19 -1 15 18 17 -1 21 20 22 -1 15 17 13 -1 14 15 13 -1 2 26 15 -1 15 26 16 -1 2 3 26 -1 26 32 33 -1 26 31 32 -1 3 31 26 -1 26 33 34 -1 16 26 34 -1 28 30 29 -1 28 27 30 -1 12 30 27 -1 12 25 30 -1 3 27 31 -1 3 12 27 -1 27 28 31 -1 28 32 31 -1 28 29 33 -1 28 33 32 -1 29 30 34 -1 29 34 33 -1 16 34 30 -1 16 30 25 -1 10 24 11 -1 10 23 24 -1 11 24 25 -1 11 25 12 -1 1 15 14 -1 1 2 15 -1 0 14 13 -1 0 1 14 -1 0 17 4 -1 0 13 17 -1 4 18 5 -1 4 17 18 -1 8 22 9 -1 8 21 22 -1 5 19 6 -1 5 18 19 -1 6 20 7 -1 6 19 20 -1 7 21 8 -1 7 20 21 -1 9 23 10 -1 9 22 23 -1 ] creaseAngle 0.4 } } Shape { appearance USE MOTOR_APPEARANCE geometry IndexedFaceSet { coord USE DArmUpperLCoord coordIndex [ 103 105 101 -1 103 101 99 -1 100 102 106 -1 100 106 104 -1 106 110 108 -1 106 108 104 -1 102 112 111 -1 102 100 112 -1 111 110 106 -1 111 106 102 -1 104 108 112 -1 104 112 100 -1 114 107 103 -1 114 103 99 -1 101 113 114 -1 101 114 99 -1 107 109 105 -1 107 105 103 -1 105 109 113 -1 105 113 101 -1 92 88 84 -1 92 84 96 -1 90 88 92 -1 90 92 94 -1 96 84 83 -1 96 83 98 -1 83 90 94 -1 83 94 98 -1 93 89 85 -1 93 85 97 -1 86 87 91 -1 86 91 95 -1 95 85 86 -1 95 97 85 -1 91 87 89 -1 91 89 93 -1 97 95 91 -1 97 91 93 -1 94 92 96 -1 94 96 98 -1 82 79 80 -1 82 81 79 -1 76 78 77 -1 76 77 75 -1 82 77 78 -1 82 80 77 -1 81 76 75 -1 81 75 79 -1 79 77 80 -1 79 75 77 -1 82 78 81 -1 81 78 76 -1 67 71 68 -1 68 71 73 -1 70 72 69 -1 70 74 72 -1 68 73 74 -1 68 74 70 -1 67 72 71 -1 67 69 72 -1 73 71 72 -1 73 72 74 -1 67 70 69 -1 67 68 70 -1 55 53 57 -1 55 51 53 -1 52 54 58 -1 52 58 56 -1 58 62 60 -1 58 60 56 -1 54 64 63 -1 54 52 64 -1 63 62 58 -1 63 58 54 -1 56 60 64 -1 56 64 52 -1 66 55 59 -1 66 51 55 -1 53 66 65 -1 53 51 66 -1 59 57 61 -1 59 55 57 -1 57 65 61 -1 57 53 65 -1 44 36 40 -1 44 48 36 -1 42 44 40 -1 42 46 44 -1 35 48 50 -1 35 36 48 -1 35 46 42 -1 35 50 46 -1 45 41 37 -1 45 37 49 -1 38 39 43 -1 38 43 47 -1 47 37 38 -1 47 49 37 -1 43 39 41 -1 43 41 45 -1 49 47 43 -1 49 43 45 -1 46 48 44 -1 46 50 48 -1 ] creaseAngle 0.2 } } ] } # ArmLowerL %< if (enable_backlash) { >% DEF DArmLowerL HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_arm_lower >% %< } else { >% DEF DArmLowerL HingeJoint { %< } >% device [ RotationalMotor { name "ArmLowerL" acceleration 55 maxVelocity 12.26 minPosition -1.18 maxPosition 1.63 maxTorque 2.5 } PositionSensor { name "ArmLowerLS" } ] jointParameters HingeJointParameters { axis 1 0 0 anchor 0 -0.06 0.016 position -0.52 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 -0.06 0.016 rotation 1 0 0 -2.0908 children [ DEF LEFT_HAND_SLOT Group { children IS leftHandSlot } DEF DArmLowerLShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DArmLowerLCoord Coordinate { point [ 0.021316 -0.0889728 -0.0160007 0.0211875 -0.0894323 -0.0247776 0.0211882 -0.0894323 -0.0072239 0.020141 -0.0931765 -0.0318913 0.0201421 -0.0931765 -0.0001101 0.0178793 -0.101268 -0.0354511 0.0178807 -0.101268 0.0034499 0.0133817 -0.117359 -0.0357492 0.013383 -0.117359 0.0037483 0.0112757 -0.124894 -0.0340975 0.0112769 -0.124894 0.0020967 0.0102082 -0.128713 -0.0294763 0.0102092 -0.128713 -0.0025244 0.0101119 -0.129057 -0.0160004 0.0247634 -0.0160601 -0.0160009 0.0246349 -0.0165195 -0.0288783 0.0246358 -0.0165195 -0.0031235 0.0235883 -0.0222589 -0.0318913 0.0235895 -0.0222589 -0.0001104 0.0213268 -0.0232768 -0.0354511 0.0213282 -0.0232768 0.0034496 0.0084479 -0.0958579 -0.0414531 0.0084497 -0.0958579 0.0094525 0.0189941 -0.0243808 -0.0379746 0.0189956 -0.0243808 0.0059733 0.0084476 -0.114721 -0.0386055 0.0084491 -0.114721 0.0066049 0.0033958 -0.0243805 -0.0379746 0.0033974 -0.0243805 0.0059743 0.0033955 -0.0444894 -0.038953 0.0033971 -0.0444894 0.0069527 -0.0015018 -0.0548154 -0.0394554 -0.0015002 -0.0548154 0.0074555 -0.0060363 -0.0578951 -0.0396052 -0.0060346 -0.0578951 0.0076056 -0.0058553 -0.0828953 -0.0408216 -0.0058536 -0.0828953 0.008822 -0.0004141 -0.0841635 -0.0408833 -0.0004123 -0.0841635 0.0088833 0.0035761 -0.0870622 -0.0410243 0.0035779 -0.0870622 0.0090241 0.0052379 -0.0958578 -0.0414531 0.0052397 -0.0958578 0.0094527 0.0052376 -0.114721 -0.0386055 0.0052392 -0.114721 0.0066051 0.0052374 -0.124894 -0.0340975 0.0052387 -0.124894 0.0020972 0.0052374 -0.128713 -0.0294763 0.0052383 -0.128713 -0.002524 0.0052373 -0.129057 -0.0160002 0.0052376 -0.114721 -0.0160002 0.0052379 -0.0958578 -0.0160002 0.0033955 -0.0444894 -0.0160001 0.0033958 -0.0243805 -0.0160001 -0.0116696 -0.0256596 -0.0293495 -0.0116686 -0.0256596 -0.0026497 -0.0117108 -0.0319478 -0.0293495 -0.0117099 -0.0319478 -0.0026497 1.3e-06 -0.0384555 -0.0293495 2.2e-06 -0.0384555 -0.0026505 0.0001588 -0.051073 -0.0293495 0.0001597 -0.051073 -0.0026505 -0.0052654 -0.0576902 -0.0293495 -0.0052645 -0.0576902 -0.0026501 -0.0052454 -0.0878142 -0.0293495 -0.0052444 -0.0878142 -0.0026501 0.0001579 -0.104224 -0.0293495 0.0001588 -0.104224 -0.0026505 0.0066037 -0.104286 -0.0160002 0.0025852 -0.114613 -0.0160001 -0.0086951 -0.114558 -0.0159997 -0.0086745 -0.116567 -0.0159997 0.0037989 -0.116663 -0.0160001 0.0073511 -0.108613 -0.0160003 0.0064391 -0.02566 -0.0293495 0.00644 -0.02566 -0.002651 0.0025852 -0.114613 -0.0293495 0.0025861 -0.114613 -0.0026507 -0.0086951 -0.114558 -0.0293495 -0.0086941 -0.114558 -0.0026499 -0.0086745 -0.116567 -0.0293495 -0.0086736 -0.116567 -0.0026499 0.0037989 -0.116663 -0.0293495 0.0037998 -0.116663 -0.0026508 0.0073511 -0.108613 -0.0293495 0.007352 -0.108613 -0.002651 -0.0116696 -0.0256596 -0.0315563 -0.0116685 -0.0256596 -0.0004429 -0.0117108 -0.0319478 -0.0315563 -0.0117097 -0.0319478 -0.0004429 1.3e-06 -0.0384555 -0.0315563 2.4e-06 -0.0384555 -0.0004437 0.0001588 -0.051073 -0.0315563 0.0001599 -0.051073 -0.0004437 -0.0052654 -0.0576902 -0.0315563 -0.0052643 -0.0576902 -0.0004433 -0.0052454 -0.0878142 -0.0315563 -0.0052443 -0.0878142 -0.0004433 0.0001579 -0.104224 -0.0315563 0.000159 -0.104224 -0.0004437 0.0064377 -0.104224 -0.0293495 0.0064387 -0.104224 -0.002651 0.0064377 -0.104224 -0.0315563 0.0064388 -0.104224 -0.0004442 0.006438 -0.0878144 -0.0315563 0.0064391 -0.0878144 -0.0004442 0.0064386 -0.0576904 -0.0315563 0.0064396 -0.0576904 -0.0004442 0.0064387 -0.0510731 -0.0315563 0.0064398 -0.0510731 -0.0004442 0.0064389 -0.0384557 -0.0315563 0.00644 -0.0384557 -0.0004442 0.006439 -0.0319481 -0.0315563 0.0064401 -0.0319481 -0.0004442 0.0064391 -0.02566 -0.0315563 0.0064402 -0.02566 -0.0004442 0.006438 -0.0878144 -0.0293495 0.006439 -0.0878144 -0.002651 0.0064386 -0.0576904 -0.0293495 0.0064395 -0.0576904 -0.002651 0.0064387 -0.0510731 -0.0293495 0.0064396 -0.0510731 -0.002651 0.0064389 -0.0384557 -0.0293495 0.0064398 -0.0384557 -0.002651 0.006439 -0.0319481 -0.0293495 0.0064399 -0.0319481 -0.002651 0.0052379 -0.0959539 -0.039479 0.0052396 -0.0959539 0.0074787 0.0035761 -0.0871582 -0.0390503 0.0035777 -0.0871582 0.00705 -0.0004141 -0.0842596 -0.0389092 -0.0004125 -0.0842596 0.0069093 -0.0058553 -0.0829914 -0.0388475 -0.0058537 -0.0829914 0.006848 -0.0060363 -0.0579911 -0.0376312 -0.0060347 -0.0579911 0.0056316 -0.0015018 -0.0549115 -0.0374813 -0.0015003 -0.0549115 0.0054814 0.0033955 -0.0445854 -0.0369789 0.003397 -0.0445854 0.0049787 0.0203417 0.002702 0.0114163 0.0203417 -0.0062094 0.009524 0.0203421 -0.0112073 0.0018311 0.0203425 -0.0092954 -0.0071087 0.0203428 -0.0016221 -0.0120783 0.0203428 0.0073461 -0.0101468 0.0203425 0.0122873 -0.002493 0.020342 0.0103754 0.0064468 0.0181779 0.0027021 0.0114162 0.0181779 -0.0062094 0.0095239 0.0181782 -0.0112073 0.001831 0.0181787 -0.0092954 -0.0071088 0.018179 -0.0016221 -0.0120784 0.018179 0.0073462 -0.0101469 0.0181787 0.0122873 -0.0024931 0.0181782 0.0103754 0.0064467 0.0219035 -0.0234641 -0.0267147 0.0219024 -0.0234347 -0.0049086 0.0203422 -0.0219683 -0.0049087 0.0203434 -0.0220723 -0.0267148 0.0203427 0.0086399 -0.0076669 0.0203418 -0.0073529 0.0075925 0.021902 -0.0073529 0.0075926 0.0219029 0.0086399 -0.0076668 -0.011192 -0.0254357 -0.015882 -0.0078701 -0.0254358 -0.0239007 0.0001489 -0.0254359 -0.0272217 0.0081676 -0.0254358 -0.0238998 0.0114887 -0.0254357 -0.0158808 0.0081667 -0.0254355 -0.0078622 0.0001477 -0.0254355 -0.0045411 -0.0078709 -0.0254355 -0.007863 -0.011192 -0.0233769 -0.015882 -0.0078701 -0.023377 -0.0239007 0.0001489 -0.0233771 -0.0272218 0.0081676 -0.023377 -0.0238999 0.0114887 -0.0233769 -0.0158809 0.0081667 -0.0233767 -0.0078622 0.0001478 -0.0234347 -0.0045411 -0.0078709 -0.0233767 -0.0078631 0.0223451 0.0040091 0.0020598 0.0223453 0.0046828 -0.0010906 0.0223454 0.0029474 -0.0037838 0.0223454 -0.0002188 -0.0044684 0.0223453 -0.0029229 -0.0027172 0.0223451 -0.0035966 0.0004332 0.022345 -0.0018295 0.0031482 0.022345 0.001305 0.003811 -0.0219962 0.001305 0.0038095 -0.0219962 -0.0018295 0.0031467 -0.0219961 -0.0035966 0.0004317 -0.0219961 -0.0029229 -0.0027187 -0.0219961 -0.0002188 -0.00447 -0.0219961 0.0029474 -0.0037853 -0.0219962 0.0046828 -0.0010922 -0.0219962 0.0040091 0.0020582 -0.0215533 0.0086399 -0.0076683 -0.0215535 -0.0073529 0.0075911 -0.0199933 -0.0073529 0.0075911 -0.0199931 0.0086399 -0.0076683 -0.0199925 -0.0220723 -0.0267162 -0.0199929 -0.0219683 -0.0049101 -0.021553 -0.0234347 -0.0049101 -0.0215526 -0.0234641 -0.0267162 -0.0178296 0.0103754 0.0064455 -0.0178295 0.0122873 -0.0024944 -0.0178293 0.0073462 -0.0101482 -0.0178291 -0.0016221 -0.0120796 -0.0178291 -0.0092954 -0.0071101 -0.0178293 -0.0112073 0.0018298 -0.0178295 -0.0062094 0.0095226 -0.0178296 0.0027021 0.011415 -0.0199934 0.0103754 0.0064454 -0.0199933 0.0122873 -0.0024944 -0.0199931 0.0073461 -0.0101482 -0.0199929 -0.0016221 -0.0120797 -0.019993 -0.0092954 -0.0071101 -0.0199931 -0.0112073 0.0018297 -0.0199933 -0.0062094 0.0095226 -0.0199935 0.002702 0.0114149 0.0203422 -0.0200317 -0.0049087 0.0219024 -0.0200317 -0.0049087 -0.021553 -0.0200317 -0.0049102 -0.0199929 -0.0200317 -0.0049101 0.0203434 -0.0110508 -0.026715 0.0219035 -0.0110508 -0.0267149 -0.0215526 -0.0110508 -0.0267165 -0.0199925 -0.0110508 -0.0267164 0.0064387 -0.104224 -0.002651 0.0064377 -0.104224 -0.0293495 0.00644 -0.02566 -0.002651 0.0064391 -0.02566 -0.0293495 0.0022139 -0.0256599 -0.0293494 0.0022148 -0.0256599 -0.0026509 0.0022125 -0.104224 -0.0293494 0.0022135 -0.104224 -0.0026509 ] } coordIndex [ 1 0 13 -1 13 0 2 -1 11 1 13 -1 2 12 13 -1 11 3 1 -1 4 12 2 -1 9 3 11 -1 4 10 12 -1 9 5 3 -1 6 10 4 -1 7 5 9 -1 6 8 10 -1 5 7 21 -1 8 6 22 -1 7 25 21 -1 26 8 22 -1 7 9 25 -1 10 8 26 -1 21 27 23 -1 28 22 24 -1 41 27 21 -1 28 42 22 -1 14 15 53 -1 16 14 53 -1 15 17 53 -1 18 16 53 -1 17 19 53 -1 20 18 53 -1 19 23 53 -1 24 20 53 -1 23 27 53 -1 28 24 53 -1 27 29 138 -1 139 30 28 -1 41 43 126 -1 127 44 42 -1 51 128 126 -1 127 129 51 -1 51 50 44 -1 51 44 127 -1 43 50 51 -1 43 51 126 -1 139 52 129 -1 129 52 51 -1 51 52 128 -1 128 52 138 -1 52 139 53 -1 139 28 53 -1 27 138 53 -1 138 52 53 -1 131 137 129 -1 129 137 139 -1 138 136 128 -1 128 136 130 -1 133 135 131 -1 131 135 137 -1 136 134 130 -1 134 132 130 -1 139 137 32 -1 139 32 30 -1 31 138 29 -1 31 136 138 -1 137 135 34 -1 137 34 32 -1 33 134 136 -1 33 136 31 -1 135 133 36 -1 135 36 34 -1 35 132 134 -1 35 134 33 -1 133 131 38 -1 133 38 36 -1 37 130 132 -1 37 132 35 -1 131 129 40 -1 131 40 38 -1 39 128 130 -1 39 130 37 -1 127 42 40 -1 127 40 129 -1 39 41 126 -1 39 126 128 -1 40 42 30 -1 42 28 30 -1 27 41 29 -1 41 39 29 -1 49 46 50 -1 46 44 50 -1 43 45 50 -1 45 49 50 -1 44 26 22 -1 44 22 42 -1 21 25 43 -1 21 43 41 -1 44 46 26 -1 46 10 26 -1 9 45 25 -1 45 43 25 -1 49 13 48 -1 13 12 48 -1 11 13 47 -1 13 49 47 -1 48 12 46 -1 12 10 46 -1 9 11 45 -1 11 47 45 -1 24 22 20 -1 22 6 20 -1 5 21 19 -1 21 23 19 -1 20 6 4 -1 20 4 18 -1 3 5 19 -1 3 19 17 -1 18 4 2 -1 18 2 16 -1 1 3 17 -1 1 17 15 -1 0 14 16 -1 0 16 2 -1 0 1 15 -1 0 15 14 -1 45 47 49 -1 46 49 48 -1 37 29 39 -1 37 31 29 -1 35 31 37 -1 35 33 31 -1 38 40 30 -1 38 30 32 -1 36 38 32 -1 36 32 34 -1 ] creaseAngle 0.5 } } Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord USE DArmLowerLCoord coordIndex [ 150 152 151 -1 155 154 148 -1 164 165 171 -1 169 167 168 -1 181 180 187 -1 183 185 184 -1 192 191 190 -1 194 188 195 -1 204 211 205 -1 209 208 207 -1 161 159 220 -1 220 159 158 -1 157 156 221 -1 221 156 162 -1 202 222 203 -1 222 197 203 -1 198 223 200 -1 223 201 200 -1 159 161 224 -1 224 161 160 -1 163 162 225 -1 225 162 156 -1 196 226 197 -1 226 203 197 -1 200 227 198 -1 227 199 198 -1 227 200 226 -1 200 203 226 -1 199 227 226 -1 199 226 196 -1 225 160 163 -1 225 224 160 -1 156 159 225 -1 225 159 224 -1 222 202 201 -1 222 201 223 -1 197 222 223 -1 197 223 198 -1 220 162 161 -1 220 221 162 -1 158 221 220 -1 158 157 221 -1 218 215 217 -1 217 215 216 -1 219 215 218 -1 219 214 215 -1 212 214 219 -1 212 213 214 -1 210 209 207 -1 210 207 206 -1 205 211 210 -1 205 210 206 -1 189 188 194 -1 189 194 193 -1 192 190 189 -1 192 189 193 -1 199 196 197 -1 199 197 198 -1 204 219 211 -1 204 212 219 -1 212 205 213 -1 212 204 205 -1 213 206 214 -1 213 205 206 -1 214 207 215 -1 214 206 207 -1 215 208 216 -1 215 207 208 -1 216 209 217 -1 216 208 209 -1 217 210 218 -1 217 209 210 -1 218 211 219 -1 218 210 211 -1 141 140 148 -1 141 148 149 -1 149 150 142 -1 149 142 141 -1 150 151 143 -1 150 143 142 -1 151 152 144 -1 151 144 143 -1 152 153 145 -1 152 145 144 -1 153 154 146 -1 153 146 145 -1 154 155 147 -1 154 147 146 -1 140 147 155 -1 140 155 148 -1 162 160 161 -1 162 163 160 -1 179 172 164 -1 179 164 171 -1 165 164 172 -1 165 172 173 -1 166 165 173 -1 166 173 174 -1 167 166 174 -1 167 174 175 -1 168 167 175 -1 168 175 176 -1 169 168 176 -1 169 176 177 -1 170 169 178 -1 169 177 178 -1 171 170 178 -1 171 178 179 -1 186 183 182 -1 186 185 183 -1 181 186 182 -1 181 187 186 -1 170 167 169 -1 170 166 167 -1 165 170 171 -1 165 166 170 -1 149 154 153 -1 149 148 154 -1 152 149 153 -1 152 150 149 -1 147 140 145 -1 147 145 146 -1 140 141 144 -1 140 144 145 -1 143 144 142 -1 144 141 142 -1 182 183 192 -1 182 192 193 -1 183 184 191 -1 183 191 192 -1 184 185 190 -1 184 190 191 -1 185 186 189 -1 185 189 190 -1 186 187 188 -1 186 188 189 -1 180 195 188 -1 180 188 187 -1 180 181 194 -1 180 194 195 -1 181 182 193 -1 181 193 194 -1 157 158 201 -1 157 201 202 -1 156 203 200 -1 156 200 159 -1 158 159 200 -1 158 200 201 -1 156 157 202 -1 156 202 203 -1 125 57 55 -1 125 55 75 -1 54 56 124 -1 54 124 74 -1 123 59 125 -1 59 57 125 -1 56 58 124 -1 58 122 124 -1 121 61 123 -1 61 59 123 -1 58 60 122 -1 60 120 122 -1 119 63 61 -1 119 61 121 -1 60 62 118 -1 60 118 120 -1 117 65 119 -1 65 63 119 -1 62 64 118 -1 64 116 118 -1 101 67 117 -1 67 65 117 -1 64 66 116 -1 66 100 116 -1 75 55 87 -1 75 87 115 -1 86 54 74 -1 86 74 114 -1 115 87 113 -1 87 89 113 -1 88 86 112 -1 86 114 112 -1 113 89 91 -1 113 91 111 -1 90 88 112 -1 90 112 110 -1 111 91 93 -1 111 93 109 -1 92 90 110 -1 92 110 108 -1 109 93 107 -1 93 95 107 -1 94 92 106 -1 92 108 106 -1 107 95 97 -1 107 97 105 -1 96 94 106 -1 96 106 104 -1 105 97 99 -1 105 99 103 -1 98 96 104 -1 98 104 102 -1 103 99 67 -1 103 67 101 -1 66 98 102 -1 66 102 100 -1 85 77 83 -1 85 101 77 -1 76 84 82 -1 76 100 84 -1 83 77 81 -1 81 77 79 -1 78 76 80 -1 80 76 82 -1 97 65 67 -1 97 67 99 -1 66 64 96 -1 66 96 98 -1 95 63 65 -1 95 65 97 -1 64 62 94 -1 64 94 96 -1 93 61 63 -1 93 63 95 -1 62 60 92 -1 62 92 94 -1 91 59 61 -1 91 61 93 -1 60 58 90 -1 60 90 92 -1 89 57 59 -1 89 59 91 -1 58 56 88 -1 58 88 90 -1 87 55 57 -1 87 57 89 -1 56 54 86 -1 56 86 88 -1 83 72 73 -1 83 73 85 -1 73 72 82 -1 73 82 84 -1 81 71 72 -1 81 72 83 -1 72 71 80 -1 72 80 82 -1 79 70 71 -1 79 71 81 -1 71 70 78 -1 71 78 80 -1 77 69 79 -1 69 70 79 -1 70 69 78 -1 69 76 78 -1 101 68 69 -1 101 69 77 -1 69 68 100 -1 69 100 76 -1 232 234 235 -1 232 235 233 -1 230 233 235 -1 230 235 228 -1 231 232 233 -1 231 233 230 -1 229 234 232 -1 229 232 231 -1 228 235 229 -1 235 234 229 -1 228 229 231 -1 228 231 230 -1 ] creaseAngle 0.2 } } ] } ] boundingObject Pose { translation 0.0075 -0.073 -0.016 children [ Box { size 0.027 0.113 0.036 } ] } physics Physics { density -1 mass 0.0592885 centerOfMass [ 0.00666564 -0.0458382 -0.0134901 ] inertiaMatrix [ 8.6855267e-05 2.1192085e-05 8.6845450e-05 5.3020311e-06 4.3636051e-07 -6.4855932e-06 ] } } } ] boundingObject Group { children [ Pose { translation 0 -0.019 0 children [ Box { size 0.036 0.044 0.04 } ] } Pose { translation 0 -0.06 0.003 children [ Box { size 0.036 0.036 0.051 } ] } ] } physics Physics { density -1 mass 0.168377 centerOfMass [ 0.000659787 -0.036239 0.000734065 ] inertiaMatrix [ 1.2202839e-04 3.8088441e-05 1.1340830e-04 -2.0812626e-06 -8.8143449e-07 1.8251448e-06 ] } } } ] name "shoulderL" boundingObject Pose { translation -0.009 -0.0065 0 rotation 0 0 1 -0.785398 children [ Box { size 0.027 0.022 0.044 } ] } physics Physics { density -1 mass 0.025913 centerOfMass [ 0.00139 -0.01352 0.01264 ] inertiaMatrix [ 9.7758165e-06 1.0511104e-05 5.4767980e-06 1.6911839e-06 -4.5174329e-07 3.3406955e-07 ] } } } # ShoulderR %< if (enable_backlash) { >% DEF DShoulderR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_shoulder >% %< } else { >% DEF DShoulderR HingeJoint { %< } >% device [ RotationalMotor { name "ShoulderR" acceleration 55 maxVelocity 12.26 minPosition -3.14 maxPosition 3.14 maxTorque 2.5 } PositionSensor { name "ShoulderRS" } ] jointParameters HingeJointParameters { axis 0 -1 0 anchor 0.0 -0.082 -0.0 position -0.84 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 -0.082 0 rotation 0.6826 0.6826 0.2611 2.6307 children [ DEF DShoulderRShape Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord Coordinate { point [ -0.0025152 -0.0272838 -0.0201519 0.0063963 -0.0253913 -0.020152 0.011394 -0.0176984 -0.0201521 0.009482 -0.0087585 -0.0201522 0.0018086 -0.0037891 -0.0201522 -0.0071596 -0.0057208 -0.0201521 -0.0121006 -0.0133746 -0.020152 -0.0101886 -0.0223144 -0.0201519 -0.0025152 -0.0272838 -0.017988 0.0063963 -0.0253913 -0.0179881 0.011394 -0.0176983 -0.0179883 0.009482 -0.0087585 -0.0179884 0.0018086 -0.0037891 -0.0179884 -0.0071596 -0.0057207 -0.0179883 -0.0121006 -0.0133746 -0.0179882 -0.0101886 -0.0223144 -0.0179881 0.0236502 0.0108478 -0.0217128 0.0236213 -0.0109584 -0.0217124 0.0221549 -0.0109583 -0.0201523 0.0222586 0.0108478 -0.0201526 -0.0084534 -0.0082007 -0.0201521 0.0075397 -0.0234598 -0.020152 0.0075397 -0.0234599 -0.0217122 -0.0084534 -0.0082007 -0.0217123 0.0256226 1.39e-05 0.0113823 0.0256226 0.0080327 0.0080607 0.0256224 0.011354 4.18e-05 0.0256223 0.0080324 -0.007977 0.0256222 1.35e-05 -0.0112984 0.0256223 -0.0080052 -0.0079767 0.0256224 -0.0113266 4.22e-05 0.0256226 -0.008005 0.0080609 0.0235638 1.39e-05 0.0113823 0.0235638 0.0080327 0.0080607 0.0235636 0.011354 4.18e-05 0.0235635 0.0080324 -0.007977 0.0235634 1.35e-05 -0.0112983 0.0235635 -0.0080052 -0.0079767 0.0236216 -0.0113266 4.22e-05 0.0235638 -0.008005 0.008061 -0.0038224 -0.0179272 -0.0221549 -0.0044962 -0.0147768 -0.022155 -0.0027608 -0.0120837 -0.022155 0.0004054 -0.0113989 -0.0221551 0.0031095 -0.0131501 -0.0221551 0.0037833 -0.0163005 -0.022155 0.0020162 -0.0190155 -0.022155 -0.0011183 -0.0196784 -0.0221549 -0.0011175 -0.0196784 0.0221863 0.002017 -0.0190155 0.0221863 0.0037841 -0.0163005 0.0221862 0.0031103 -0.0131501 0.0221863 0.0004062 -0.0113989 0.0221864 -0.0027601 -0.0120837 0.0221865 -0.0044954 -0.0147768 0.0221865 -0.0038216 -0.0179272 0.0221864 -0.0084526 -0.0082007 0.0217439 0.0075404 -0.0234599 0.0217433 0.0075404 -0.0234598 0.0201831 -0.0084527 -0.0082007 0.0201838 0.0222593 0.0108478 0.0201832 0.0221556 -0.0109583 0.0201828 0.023622 -0.0109584 0.021743 0.023651 0.0108478 0.0217434 -0.0101879 -0.0223144 0.0180198 -0.0121 -0.0133746 0.01802 -0.007159 -0.0057207 0.0180199 0.0018092 -0.0037891 0.0180197 0.0094826 -0.0087585 0.0180194 0.0113947 -0.0176983 0.0180193 0.0063969 -0.0253913 0.0180193 -0.0025145 -0.0272838 0.0180195 -0.0101879 -0.0223144 0.0201836 -0.0120999 -0.0133746 0.0201838 -0.0071589 -0.0057208 0.0201838 0.0018093 -0.0037891 0.0201835 0.0094827 -0.0087585 0.0201833 0.0113947 -0.0176984 0.0201831 0.006397 -0.0253913 0.0201831 -0.0025145 -0.0272838 0.0201833 0.0202183 -0.0109583 -0.0201522 0.0202183 -0.0109584 -0.0217124 0.020219 -0.0109584 0.021743 0.020219 -0.0109583 0.0201829 0.0112371 0.0108478 -0.0201524 0.011237 0.0108478 -0.0217126 0.0112378 0.0108478 0.0217436 0.0112378 0.0108478 0.0201834 ] } coordIndex [ 10 11 12 -1 15 8 14 -1 24 31 25 -1 29 28 27 -1 41 47 40 -1 43 44 45 -1 52 50 51 -1 54 55 48 -1 64 65 71 -1 69 67 68 -1 21 80 19 -1 80 18 19 -1 17 81 16 -1 81 22 16 -1 62 63 82 -1 82 63 57 -1 58 60 83 -1 83 60 61 -1 19 84 21 -1 84 20 21 -1 23 85 22 -1 85 16 22 -1 56 57 86 -1 86 57 63 -1 60 58 87 -1 87 58 59 -1 87 86 60 -1 60 86 63 -1 59 86 87 -1 59 56 86 -1 85 23 20 -1 85 20 84 -1 16 85 19 -1 85 84 19 -1 82 61 62 -1 82 83 61 -1 57 83 82 -1 57 58 83 -1 80 21 22 -1 80 22 81 -1 18 80 81 -1 18 81 17 -1 78 77 75 -1 77 76 75 -1 79 78 75 -1 79 75 74 -1 72 79 74 -1 72 74 73 -1 70 67 69 -1 70 66 67 -1 65 70 71 -1 65 66 70 -1 49 54 48 -1 49 53 54 -1 52 49 50 -1 52 53 49 -1 59 57 56 -1 59 58 57 -1 64 71 79 -1 64 79 72 -1 72 73 65 -1 72 65 64 -1 73 74 66 -1 73 66 65 -1 74 75 67 -1 74 67 66 -1 75 76 68 -1 75 68 67 -1 76 77 69 -1 76 69 68 -1 77 78 70 -1 77 70 69 -1 78 79 71 -1 78 71 70 -1 8 0 1 -1 1 9 8 -1 9 2 10 -1 9 1 2 -1 10 3 11 -1 10 2 3 -1 11 4 12 -1 11 3 4 -1 12 5 13 -1 12 4 5 -1 13 6 14 -1 13 5 6 -1 14 7 15 -1 14 6 7 -1 0 15 7 -1 0 8 15 -1 22 21 20 -1 22 20 23 -1 39 24 32 -1 39 31 24 -1 25 32 24 -1 25 33 32 -1 26 33 25 -1 26 34 33 -1 27 34 26 -1 27 35 34 -1 28 35 27 -1 28 36 35 -1 29 36 28 -1 29 37 36 -1 30 38 29 -1 29 38 37 -1 31 38 30 -1 31 39 38 -1 46 42 43 -1 46 43 45 -1 41 42 46 -1 41 46 47 -1 30 29 27 -1 30 27 26 -1 25 31 30 -1 25 30 26 -1 9 13 14 -1 9 14 8 -1 12 13 9 -1 12 9 10 -1 5 0 7 -1 7 6 5 -1 0 4 1 -1 0 5 4 -1 3 2 4 -1 4 2 1 -1 42 52 43 -1 42 53 52 -1 43 51 44 -1 43 52 51 -1 44 50 45 -1 44 51 50 -1 45 49 46 -1 45 50 49 -1 46 48 47 -1 46 49 48 -1 40 48 55 -1 40 47 48 -1 40 54 41 -1 40 55 54 -1 41 53 42 -1 41 54 53 -1 17 61 18 -1 17 62 61 -1 16 60 63 -1 16 19 60 -1 18 60 19 -1 18 61 60 -1 16 62 17 -1 16 63 62 -1 ] creaseAngle 0.2 } } # ArmUpperR %< if (enable_backlash) { >% DEF DArmUpperR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_arm_upper >% %< } else { >% DEF DArmUpperR HingeJoint { %< } >% device [ RotationalMotor { name "ArmUpperR" acceleration 55 maxVelocity 12.26 minPosition -0.68 maxPosition 2.3 maxTorque 2.5 } PositionSensor { name "ArmUpperRS" } ] jointParameters HingeJointParameters { axis 0 0 -1 anchor 0 -0.016 0 position -0.33 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 -0.016 0 rotation 0 0 -1 0.4554 children [ DEF DArmUpperRShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DArmUpperRCoord Coordinate { point [ 0.0156138 -0.011514 0.0201599 0.0156134 -0.0373797 0.0201595 0.0116704 -0.0403762 0.0201594 -0.0161016 -0.0403757 0.0201594 -0.0041009 -0.0116714 0.0201599 -0.00899 -0.0072552 0.02016 -0.0091475 0.0045736 0.0201602 -0.0064663 0.0080434 0.0201603 0.0058357 0.0080432 0.0201603 0.0059935 0.0146673 0.0201604 -0.0102514 0.0130904 0.0201604 -0.014839 0.0107247 0.0201603 -0.0161008 0.0073235 0.0201603 0.0156138 -0.0115133 -0.0198866 0.0156134 -0.037379 -0.019887 0.0116704 -0.0403755 -0.0198871 -0.0161016 -0.040375 -0.0198871 -0.0041009 -0.0116707 -0.0198866 -0.00899 -0.0072545 -0.0198865 -0.0091475 0.0045743 -0.0198863 -0.0064663 0.0080441 -0.0198863 0.0058357 0.0080439 -0.0198863 0.0059935 0.014668 -0.0198861 -0.0102514 0.0130911 -0.0198862 -0.014839 0.0107254 -0.0198862 -0.0161008 0.0073242 -0.0198863 -0.0161016 -0.0403754 0.0001362 -0.02011 -0.0119166 0.0121506 -0.0210102 -0.0162362 0.0041412 -0.0210102 -0.016236 -0.0038681 -0.02011 -0.0119162 -0.0118773 -0.0201106 -0.0454278 0.01215 -0.0210107 -0.0480778 0.0041407 -0.0210107 -0.0480777 -0.0038686 -0.0201106 -0.0454274 -0.0118779 -0.0150266 -0.0472415 0.0225037 -0.0150274 -0.0472399 -0.0278544 -0.0150266 -0.0726358 0.0225028 -0.0150274 -0.0726342 -0.0278553 -0.0106236 -0.0726342 -0.0278553 -0.0106236 -0.0472399 -0.0278545 -0.0106228 -0.0726359 0.0225027 -0.0106229 -0.0472416 0.0225036 -0.0106235 -0.0778283 -0.0219414 -0.0106235 -0.0422107 -0.0219401 -0.0106229 -0.0778296 0.0165884 -0.0106229 -0.0422119 0.0165896 -0.0150273 -0.0778283 -0.0219413 -0.0150273 -0.0422107 -0.0219401 -0.0150267 -0.0778296 0.0165884 -0.0150267 -0.0422119 0.0165897 0.0102081 -0.0422124 0.0165897 0.0102081 -0.07783 0.0165884 0.0102075 -0.0422111 -0.0219401 0.0102075 -0.0778288 -0.0219413 0.0146119 -0.0422124 0.0165896 0.0146119 -0.07783 0.0165884 0.0146113 -0.0422111 -0.0219401 0.0146113 -0.0778288 -0.0219414 0.014612 -0.047242 0.0225036 0.014612 -0.0726363 0.0225027 0.0146112 -0.0472403 -0.0278545 0.0146112 -0.0726346 -0.0278553 0.0102074 -0.0726346 -0.0278553 0.0102082 -0.0726363 0.0225028 0.0102074 -0.0472403 -0.0278544 0.0102082 -0.047242 0.0225037 -0.0183666 -0.0726342 -0.0278553 -0.0183658 -0.0726358 0.0225028 -0.0183666 -0.0472399 -0.0278544 -0.0183658 -0.0472415 0.0225037 0.0176078 -0.0726346 -0.0278554 0.0176078 -0.0472403 -0.0278545 0.0176086 -0.0726363 0.0225027 0.0176086 -0.047242 0.0225035 0.012489 0.0116448 0.0180959 -0.0129053 0.0116448 0.0180963 0.0124889 -0.0387132 0.0180942 -0.0129054 -0.0387132 0.0180947 0.0124888 0.0116456 -0.0178785 0.0124888 -0.0387125 -0.0178802 -0.0129054 0.0116456 -0.0178781 -0.0129055 -0.0387125 -0.0178798 0.0124889 0.0116451 0.0106955 0.0124888 -0.038713 0.0106938 -0.0129054 0.011645 0.0106959 -0.0129055 -0.038713 0.0106943 -0.0129054 -0.0387131 0.015098 0.0124889 -0.0387131 0.0150976 -0.0129053 0.0116449 0.0150997 0.012489 0.0116449 0.0150992 -0.0180994 -0.032799 0.0150983 0.0175183 -0.032799 0.0150977 -0.0180993 0.0057308 0.0150996 0.0175184 0.0057308 0.015099 -0.0180994 -0.0327989 0.0106946 0.0175182 -0.0327988 0.0106939 -0.0180993 0.0057309 0.0106958 0.0175183 0.0057309 0.0106952 0.0175183 0.0057313 -0.0145396 -0.0180993 0.0057313 -0.014539 0.0175182 -0.0327984 -0.0145409 -0.0180994 -0.0327984 -0.0145402 0.0175184 0.0057312 -0.0101359 -0.0180993 0.0057312 -0.0101352 0.0175183 -0.0327985 -0.0101371 -0.0180994 -0.0327985 -0.0101365 0.012489 0.0116454 -0.0101356 -0.0129053 0.0116454 -0.0101351 0.0124889 -0.0387127 -0.0101372 -0.0129054 -0.0387127 -0.0101368 -0.0129055 -0.0387126 -0.0145406 -0.0129054 0.0116455 -0.0145389 0.0124888 -0.0387126 -0.014541 0.0124889 0.0116455 -0.0145393 ] } coordIndex [ 3 11 12 -1 5 11 3 -1 2 5 3 -1 5 10 11 -1 7 9 10 -1 6 7 10 -1 5 6 10 -1 2 4 5 -1 8 9 7 -1 2 0 4 -1 1 0 2 -1 16 25 24 -1 18 16 24 -1 15 16 18 -1 18 24 23 -1 20 23 22 -1 19 23 20 -1 18 23 19 -1 15 18 17 -1 21 20 22 -1 15 17 13 -1 14 15 13 -1 2 26 15 -1 15 26 16 -1 2 3 26 -1 26 32 33 -1 26 31 32 -1 3 31 26 -1 26 33 34 -1 16 26 34 -1 28 30 29 -1 28 27 30 -1 12 30 27 -1 12 25 30 -1 3 27 31 -1 3 12 27 -1 27 28 31 -1 28 32 31 -1 28 29 33 -1 28 33 32 -1 29 30 34 -1 29 34 33 -1 16 34 30 -1 16 30 25 -1 10 24 11 -1 10 23 24 -1 11 24 25 -1 11 25 12 -1 1 15 14 -1 1 2 15 -1 0 14 13 -1 0 1 14 -1 0 17 4 -1 0 13 17 -1 4 18 5 -1 4 17 18 -1 8 22 9 -1 8 21 22 -1 5 19 6 -1 5 18 19 -1 6 20 7 -1 6 19 20 -1 7 21 8 -1 7 20 21 -1 9 23 10 -1 9 22 23 -1 ] creaseAngle 0.2 } } Shape { appearance USE MOTOR_APPEARANCE geometry IndexedFaceSet { coord USE DArmUpperRCoord coordIndex [ 103 105 101 -1 103 101 99 -1 100 102 106 -1 100 106 104 -1 106 110 108 -1 106 108 104 -1 102 112 111 -1 102 100 112 -1 111 110 106 -1 111 106 102 -1 104 108 112 -1 104 112 100 -1 114 107 103 -1 114 103 99 -1 101 113 114 -1 101 114 99 -1 107 109 105 -1 107 105 103 -1 105 109 113 -1 105 113 101 -1 92 88 84 -1 92 84 96 -1 90 88 92 -1 90 92 94 -1 96 84 83 -1 96 83 98 -1 83 90 94 -1 83 94 98 -1 93 89 85 -1 93 85 97 -1 86 87 91 -1 86 91 95 -1 95 85 86 -1 95 97 85 -1 91 87 89 -1 91 89 93 -1 97 95 91 -1 97 91 93 -1 94 92 96 -1 94 96 98 -1 82 79 80 -1 82 81 79 -1 76 78 77 -1 76 77 75 -1 82 77 78 -1 82 80 77 -1 81 76 75 -1 81 75 79 -1 79 77 80 -1 79 75 77 -1 82 78 81 -1 81 78 76 -1 67 71 68 -1 68 71 73 -1 70 72 69 -1 70 74 72 -1 68 73 74 -1 68 74 70 -1 67 72 71 -1 67 69 72 -1 73 71 72 -1 73 72 74 -1 67 70 69 -1 67 68 70 -1 55 53 57 -1 55 51 53 -1 52 54 58 -1 52 58 56 -1 58 62 60 -1 58 60 56 -1 54 64 63 -1 54 52 64 -1 63 62 58 -1 63 58 54 -1 56 60 64 -1 56 64 52 -1 66 55 59 -1 66 51 55 -1 53 66 65 -1 53 51 66 -1 59 57 61 -1 59 55 57 -1 57 65 61 -1 57 53 65 -1 44 36 40 -1 44 48 36 -1 42 44 40 -1 42 46 44 -1 35 48 50 -1 35 36 48 -1 35 46 42 -1 35 50 46 -1 45 41 37 -1 45 37 49 -1 38 39 43 -1 38 43 47 -1 47 37 38 -1 47 49 37 -1 43 39 41 -1 43 41 45 -1 49 47 43 -1 49 43 45 -1 46 48 44 -1 46 50 48 -1 ] creaseAngle 0.2 } } ] } # ArmLowerR %< if (enable_backlash) { >% DEF DArmLowerR HingeJointWithBacklash { gearMass 0.001 backlash %<= backlash_arm_lower >% %< } else { >% DEF DArmLowerR HingeJoint { %< } >% device [ RotationalMotor { name "ArmLowerR" acceleration 55 maxVelocity 12.26 minPosition -1.65 maxPosition 1.16 maxTorque 2.5 } PositionSensor { name "ArmLowerRS" } ] jointParameters HingeJointParameters { axis -1 0 0 anchor 0 -0.06 0.016 position 0.51 dampingConstant 0.002 staticFriction 0.025 } endPoint Solid { translation 0 -0.06 0.016 rotation -1 0 0 2.0808 children [ DEF RIGHT_HAND_SLOT Group { children IS rightHandSlot } DEF DArmLowerRShape Group { children [ Shape { appearance USE PLASTIC_APPEARANCE geometry IndexedFaceSet { coord DEF DArmLowerRCoord Coordinate { point [ -0.0213191 -0.0889727 -0.0159976 -0.0211907 -0.0894324 -0.0247745 -0.0211913 -0.0894318 -0.0072208 -0.0201442 -0.0931769 -0.031888 -0.0201453 -0.0931758 -0.0001069 -0.0178828 -0.101269 -0.0354476 -0.0178842 -0.101267 0.0034534 -0.0133858 -0.11736 -0.0357452 -0.0133871 -0.117359 0.0037524 -0.01128 -0.124895 -0.0340932 -0.0112813 -0.124893 0.0021011 -0.0102127 -0.128713 -0.0294718 -0.0102137 -0.128712 -0.0025199 -0.0101165 -0.129057 -0.0159958 -0.0247639 -0.0160598 -0.0160003 -0.0246355 -0.0165196 -0.0288777 -0.0246364 -0.0165187 -0.0031229 -0.0235891 -0.0222592 -0.0318905 -0.0235902 -0.0222581 -0.0001096 -0.0213276 -0.0232773 -0.0354503 -0.021329 -0.0232759 0.0034504 -0.0084512 -0.095859 -0.0414497 -0.008453 -0.0958572 0.0094558 -0.018995 -0.0243814 -0.0379737 -0.0189965 -0.0243799 0.0059741 -0.0084516 -0.114722 -0.0386015 -0.0084531 -0.114721 0.0066089 -0.0033967 -0.0243817 -0.0379737 -0.0033982 -0.0243802 0.0059752 -0.003397 -0.0444906 -0.0389514 -0.0033986 -0.044489 0.0069543 0.0014999 -0.0548169 -0.0394535 0.0014983 -0.0548152 0.0074574 0.0060342 -0.0578967 -0.0396032 0.0060326 -0.057895 0.0076077 0.0058524 -0.0828969 -0.0408187 0.0058507 -0.0828952 0.0088249 0.0004111 -0.084165 -0.0408804 0.0004094 -0.0841632 0.0088863 -0.0035792 -0.0870635 -0.0410213 -0.0035809 -0.0870617 0.0090271 -0.0052413 -0.0958591 -0.0414497 -0.0052431 -0.0958573 0.009456 -0.0052416 -0.114722 -0.0386015 -0.0052432 -0.114721 0.0066091 -0.0052418 -0.124895 -0.0340932 -0.005243 -0.124893 0.0021015 -0.0052418 -0.128713 -0.0294718 -0.0052428 -0.128713 -0.0025195 -0.0052419 -0.129057 -0.0159957 -0.0052416 -0.114722 -0.0159962 -0.0052413 -0.0958582 -0.0159968 -0.003397 -0.0444898 -0.0159986 -0.0033967 -0.0243809 -0.0159993 0.0116687 -0.0256611 -0.0293486 0.0116677 -0.0256601 -0.0026488 0.0117097 -0.0319492 -0.0293484 0.0117088 -0.0319483 -0.0026486 -2.7e-06 -0.0384566 -0.0293482 -3.6e-06 -0.0384556 -0.0026492 -0.0001606 -0.051074 -0.0293477 -0.0001615 -0.051073 -0.0026487 0.0052634 -0.0576914 -0.0293475 0.0052625 -0.0576904 -0.0026481 0.0052423 -0.0878154 -0.0293464 0.0052414 -0.0878145 -0.0026471 -0.0001615 -0.104225 -0.0293459 -0.0001625 -0.104224 -0.0026469 -0.0066074 -0.104286 -0.0159966 -0.0025892 -0.114613 -0.0159961 0.0086911 -0.114558 -0.0159957 0.0086705 -0.116568 -0.0159956 -0.003803 -0.116663 -0.0159961 -0.0073549 -0.108613 -0.0159965 -0.00644 -0.0256608 -0.0293486 -0.0064409 -0.0256598 -0.0026501 -0.0025892 -0.114614 -0.0293455 -0.0025901 -0.114613 -0.0026467 0.0086911 -0.114559 -0.0293455 0.0086901 -0.114558 -0.0026459 0.0086705 -0.116568 -0.0293454 0.0086695 -0.116567 -0.0026458 -0.003803 -0.116664 -0.0293454 -0.0038039 -0.116663 -0.0026467 -0.0073549 -0.108613 -0.0293457 -0.0073558 -0.108612 -0.0026472 0.0116687 -0.0256611 -0.0315554 0.0116676 -0.0256601 -0.000442 0.0117097 -0.0319493 -0.0315552 0.0117086 -0.0319482 -0.0004418 -2.7e-06 -0.0384566 -0.0315549 -3.7e-06 -0.0384556 -0.0004424 -0.0001606 -0.0510741 -0.0315545 -0.0001617 -0.051073 -0.0004419 0.0052634 -0.0576914 -0.0315543 0.0052623 -0.0576904 -0.0004413 0.0052423 -0.0878155 -0.0315532 0.0052412 -0.0878144 -0.0004403 -0.0001615 -0.104225 -0.0315527 -0.0001626 -0.104224 -0.0004401 -0.0064414 -0.104225 -0.0293459 -0.0064423 -0.104224 -0.0026473 -0.0064414 -0.104225 -0.0315526 -0.0064425 -0.104224 -0.0004405 -0.0064411 -0.0878153 -0.0315532 -0.0064422 -0.0878142 -0.0004411 -0.0064406 -0.0576912 -0.0315543 -0.0064417 -0.0576902 -0.0004421 -0.0064405 -0.0510739 -0.0315545 -0.0064415 -0.0510729 -0.0004424 -0.0064402 -0.0384565 -0.0315549 -0.0064413 -0.0384554 -0.0004428 -0.0064401 -0.031949 -0.0315552 -0.0064412 -0.0319479 -0.000443 -0.00644 -0.0256608 -0.0315554 -0.0064411 -0.0256597 -0.0004433 -0.0064411 -0.0878152 -0.0293464 -0.006442 -0.0878143 -0.0026479 -0.0064406 -0.0576912 -0.0293475 -0.0064415 -0.0576902 -0.0026489 -0.0064405 -0.0510739 -0.0293477 -0.0064414 -0.0510729 -0.0026492 -0.0064402 -0.0384565 -0.0293482 -0.0064412 -0.0384555 -0.0026496 -0.0064401 -0.0319489 -0.0293484 -0.006441 -0.031948 -0.0026498 -0.0052413 -0.0959551 -0.0394757 -0.0052429 -0.0959534 0.007482 -0.0035792 -0.0871594 -0.0390472 -0.0035808 -0.0871578 0.0070531 0.0004111 -0.0842609 -0.0389063 0.0004095 -0.0842594 0.0069122 0.0058524 -0.0829929 -0.0388446 0.0058508 -0.0829913 0.0068509 0.0060342 -0.0579927 -0.0376292 0.0060327 -0.0579912 0.0056336 0.0014999 -0.0549128 -0.0374794 0.0014984 -0.0549114 0.0054834 -0.003397 -0.0445866 -0.0369774 -0.0033985 -0.0445851 0.0049802 -0.0203416 0.0027032 0.0114162 -0.0203419 -0.0062084 0.0095242 -0.0203424 -0.0112066 0.0018315 -0.0203428 -0.009295 -0.0071084 -0.0203429 -0.0016218 -0.0120782 -0.0203426 0.0073465 -0.0101471 -0.0203421 0.0122879 -0.0024935 -0.0203417 0.0103763 0.0064464 -0.0181778 0.0027031 0.0114161 -0.0181781 -0.0062084 0.0095241 -0.0181786 -0.0112066 0.0018314 -0.018179 -0.009295 -0.0071085 -0.0181791 -0.0016219 -0.0120783 -0.0181787 0.0073464 -0.0101472 -0.0181782 0.0122878 -0.0024936 -0.0181779 0.0103763 0.0064464 -0.0219044 -0.0234642 -0.0267139 -0.0219032 -0.0234341 -0.0049078 -0.020343 -0.0219677 -0.0049079 -0.0203442 -0.0220726 -0.0267141 -0.0203424 0.0086404 -0.0076672 -0.0203421 -0.0073519 0.0075928 -0.0219022 -0.0073519 0.0075929 -0.0219026 0.0086404 -0.0076671 0.0111911 -0.0254366 -0.0158811 0.0078692 -0.0254369 -0.0238998 -0.0001498 -0.0254368 -0.0272209 -0.0081685 -0.0254364 -0.0238989 -0.0114896 -0.0254358 -0.0158799 -0.0081676 -0.0254355 -0.0078613 -0.0001486 -0.0254356 -0.0045402 0.00787 -0.0254361 -0.0078621 0.0111912 -0.0233778 -0.0158812 0.0078692 -0.0233781 -0.0238999 -0.0001498 -0.023378 -0.027221 -0.0081684 -0.0233776 -0.023899 -0.0114895 -0.023377 -0.01588 -0.0081676 -0.0233767 -0.0078614 -0.0001486 -0.0234348 -0.0045403 0.0078701 -0.0233773 -0.0078622 -0.022345 0.0040099 0.0020596 -0.0223451 0.0046835 -0.0010908 -0.0223453 0.0029481 -0.0037839 -0.0223454 -0.0002182 -0.0044684 -0.0223454 -0.0029222 -0.0027171 -0.0223453 -0.0035958 0.0004333 -0.0223451 -0.0018286 0.0031483 -0.022345 0.0013059 0.003811 0.0219963 0.0013044 0.0038094 0.0219961 -0.0018302 0.0031467 0.021996 -0.0035974 0.0004318 0.021996 -0.0029238 -0.0027186 0.021996 -0.0002197 -0.00447 0.0219962 0.0029465 -0.0037854 0.0219963 0.004682 -0.0010923 0.0219964 0.0040084 0.0020581 0.0215536 0.0086389 -0.0076686 0.0215532 -0.0073534 0.0075913 0.019993 -0.0073533 0.0075914 0.0199934 0.008639 -0.0076686 0.0199917 -0.022074 -0.0267155 0.0199921 -0.0219691 -0.0049093 0.0215522 -0.0234356 -0.0049093 0.0215518 -0.0234657 -0.0267154 0.01783 0.010375 0.0064451 0.0178299 0.0122866 -0.0024948 0.0178295 0.0073452 -0.0101484 0.0178291 -0.0016231 -0.0120796 0.0178288 -0.0092963 -0.0071098 0.0178289 -0.0112079 0.0018301 0.0178293 -0.0062097 0.0095229 0.0178297 0.0027019 0.0114149 0.0199938 0.0103749 0.006445 0.0199937 0.0122865 -0.0024949 0.0199933 0.0073451 -0.0101485 0.0199929 -0.0016232 -0.0120796 0.0199926 -0.0092964 -0.0071098 0.0199927 -0.011208 0.0018301 0.0199931 -0.0062098 0.0095228 0.0199936 0.0027017 0.0114148 -0.0203429 -0.0200312 -0.004908 -0.0219031 -0.0200311 -0.004908 0.0215523 -0.0200326 -0.0049095 0.0199922 -0.0200326 -0.0049094 -0.0203438 -0.0110511 -0.0267146 -0.0219039 -0.011051 -0.0267146 0.0215523 -0.0110525 -0.0267161 0.0199921 -0.0110525 -0.026716 -0.0064423 -0.104224 -0.0026473 -0.0064414 -0.104225 -0.0293459 -0.0064409 -0.0256598 -0.0026501 -0.00644 -0.0256608 -0.0293486 -0.0022148 -0.0256608 -0.0293485 -0.0022157 -0.0256599 -0.00265 -0.0022162 -0.104225 -0.0293458 -0.0022171 -0.104224 -0.0026472 ] } coordIndex [ 13 0 1 -1 2 0 13 -1 11 13 1 -1 2 13 12 -1 11 1 3 -1 4 2 12 -1 9 11 3 -1 4 12 10 -1 9 3 5 -1 6 4 10 -1 7 9 5 -1 6 10 8 -1 5 21 7 -1 8 22 6 -1 7 21 25 -1 26 22 8 -1 7 25 9 -1 10 26 8 -1 21 23 27 -1 28 24 22 -1 41 21 27 -1 28 22 42 -1 14 53 15 -1 16 53 14 -1 15 53 17 -1 18 53 16 -1 17 53 19 -1 20 53 18 -1 19 53 23 -1 24 53 20 -1 23 53 27 -1 28 53 24 -1 27 138 29 -1 139 28 30 -1 41 126 43 -1 127 42 44 -1 51 126 128 -1 127 51 129 -1 51 44 50 -1 51 127 44 -1 43 51 50 -1 43 126 51 -1 139 129 52 -1 129 51 52 -1 51 128 52 -1 128 138 52 -1 52 53 139 -1 139 53 28 -1 27 53 138 -1 138 53 52 -1 131 129 137 -1 129 139 137 -1 138 128 136 -1 128 130 136 -1 133 131 135 -1 131 137 135 -1 136 130 134 -1 134 130 132 -1 139 32 137 -1 139 30 32 -1 31 29 138 -1 31 138 136 -1 137 34 135 -1 137 32 34 -1 33 136 134 -1 33 31 136 -1 135 36 133 -1 135 34 36 -1 35 134 132 -1 35 33 134 -1 133 38 131 -1 133 36 38 -1 37 132 130 -1 37 35 132 -1 131 40 129 -1 131 38 40 -1 39 130 128 -1 39 37 130 -1 127 40 42 -1 127 129 40 -1 39 126 41 -1 39 128 126 -1 40 30 42 -1 42 30 28 -1 27 29 41 -1 41 29 39 -1 49 50 46 -1 46 50 44 -1 43 50 45 -1 45 50 49 -1 44 22 26 -1 44 42 22 -1 21 43 25 -1 21 41 43 -1 44 26 46 -1 46 26 10 -1 9 25 45 -1 45 25 43 -1 49 48 13 -1 13 48 12 -1 11 47 13 -1 13 47 49 -1 48 46 12 -1 12 46 10 -1 9 45 11 -1 11 45 47 -1 24 20 22 -1 22 20 6 -1 5 19 21 -1 21 19 23 -1 20 4 6 -1 20 18 4 -1 3 19 5 -1 3 17 19 -1 18 2 4 -1 18 16 2 -1 1 17 3 -1 1 15 17 -1 0 16 14 -1 0 2 16 -1 0 15 1 -1 0 14 15 -1 45 49 47 -1 46 48 49 -1 37 39 29 -1 37 29 31 -1 35 37 31 -1 35 31 33 -1 38 30 40 -1 38 32 30 -1 36 32 38 -1 36 34 32 -1 ] creaseAngle 0.2 } } Shape { appearance USE METAL_APPEARANCE geometry IndexedFaceSet { coord USE DArmLowerRCoord coordIndex [ 150 151 152 -1 155 148 154 -1 164 171 165 -1 169 168 167 -1 181 187 180 -1 183 184 185 -1 192 190 191 -1 194 195 188 -1 204 205 211 -1 209 207 208 -1 161 220 159 -1 220 158 159 -1 157 221 156 -1 221 162 156 -1 202 203 222 -1 222 203 197 -1 198 200 223 -1 223 200 201 -1 159 224 161 -1 224 160 161 -1 163 225 162 -1 225 156 162 -1 196 197 226 -1 226 197 203 -1 200 198 227 -1 227 198 199 -1 227 226 200 -1 200 226 203 -1 199 226 227 -1 199 196 226 -1 225 163 160 -1 225 160 224 -1 156 225 159 -1 225 224 159 -1 222 201 202 -1 222 223 201 -1 197 223 222 -1 197 198 223 -1 220 161 162 -1 220 162 221 -1 158 220 221 -1 158 221 157 -1 218 217 215 -1 217 216 215 -1 219 218 215 -1 219 215 214 -1 212 219 214 -1 212 214 213 -1 210 207 209 -1 210 206 207 -1 205 210 211 -1 205 206 210 -1 189 194 188 -1 189 193 194 -1 192 189 190 -1 192 193 189 -1 199 197 196 -1 199 198 197 -1 204 211 219 -1 204 219 212 -1 212 213 205 -1 212 205 204 -1 213 214 206 -1 213 206 205 -1 214 215 207 -1 214 207 206 -1 215 216 208 -1 215 208 207 -1 216 217 209 -1 216 209 208 -1 217 218 210 -1 217 210 209 -1 218 219 211 -1 218 211 210 -1 141 148 140 -1 141 149 148 -1 149 142 150 -1 149 141 142 -1 150 143 151 -1 150 142 143 -1 151 144 152 -1 151 143 144 -1 152 145 153 -1 152 144 145 -1 153 146 154 -1 153 145 146 -1 154 147 155 -1 154 146 147 -1 140 155 147 -1 140 148 155 -1 162 161 160 -1 162 160 163 -1 179 164 172 -1 179 171 164 -1 165 172 164 -1 165 173 172 -1 166 173 165 -1 166 174 173 -1 167 174 166 -1 167 175 174 -1 168 175 167 -1 168 176 175 -1 169 176 168 -1 169 177 176 -1 170 178 169 -1 169 178 177 -1 171 178 170 -1 171 179 178 -1 186 182 183 -1 186 183 185 -1 181 182 186 -1 181 186 187 -1 170 169 167 -1 170 167 166 -1 165 171 170 -1 165 170 166 -1 149 153 154 -1 149 154 148 -1 152 153 149 -1 152 149 150 -1 147 145 140 -1 147 146 145 -1 140 144 141 -1 140 145 144 -1 143 142 144 -1 144 142 141 -1 182 192 183 -1 182 193 192 -1 183 191 184 -1 183 192 191 -1 184 190 185 -1 184 191 190 -1 185 189 186 -1 185 190 189 -1 186 188 187 -1 186 189 188 -1 180 188 195 -1 180 187 188 -1 180 194 181 -1 180 195 194 -1 181 193 182 -1 181 194 193 -1 157 201 158 -1 157 202 201 -1 156 200 203 -1 156 159 200 -1 158 200 159 -1 158 201 200 -1 156 202 157 -1 156 203 202 -1 125 55 57 -1 125 75 55 -1 54 124 56 -1 54 74 124 -1 123 125 59 -1 59 125 57 -1 56 124 58 -1 58 124 122 -1 121 123 61 -1 61 123 59 -1 58 122 60 -1 60 122 120 -1 119 61 63 -1 119 121 61 -1 60 118 62 -1 60 120 118 -1 117 119 65 -1 65 119 63 -1 62 118 64 -1 64 118 116 -1 101 117 67 -1 67 117 65 -1 64 116 66 -1 66 116 100 -1 75 87 55 -1 75 115 87 -1 86 74 54 -1 86 114 74 -1 115 113 87 -1 87 113 89 -1 88 112 86 -1 86 112 114 -1 113 91 89 -1 113 111 91 -1 90 112 88 -1 90 110 112 -1 111 93 91 -1 111 109 93 -1 92 110 90 -1 92 108 110 -1 109 107 93 -1 93 107 95 -1 94 106 92 -1 92 106 108 -1 107 97 95 -1 107 105 97 -1 96 106 94 -1 96 104 106 -1 105 99 97 -1 105 103 99 -1 98 104 96 -1 98 102 104 -1 103 67 99 -1 103 101 67 -1 66 102 98 -1 66 100 102 -1 85 83 77 -1 85 77 101 -1 76 82 84 -1 76 84 100 -1 83 81 77 -1 81 79 77 -1 78 80 76 -1 80 82 76 -1 97 67 65 -1 97 99 67 -1 66 96 64 -1 66 98 96 -1 95 65 63 -1 95 97 65 -1 64 94 62 -1 64 96 94 -1 93 63 61 -1 93 95 63 -1 62 92 60 -1 62 94 92 -1 91 61 59 -1 91 93 61 -1 60 90 58 -1 60 92 90 -1 89 59 57 -1 89 91 59 -1 58 88 56 -1 58 90 88 -1 87 57 55 -1 87 89 57 -1 56 86 54 -1 56 88 86 -1 83 73 72 -1 83 85 73 -1 73 82 72 -1 73 84 82 -1 81 72 71 -1 81 83 72 -1 72 80 71 -1 72 82 80 -1 79 71 70 -1 79 81 71 -1 71 78 70 -1 71 80 78 -1 77 79 69 -1 69 79 70 -1 70 78 69 -1 69 78 76 -1 101 69 68 -1 101 77 69 -1 69 100 68 -1 69 76 100 -1 232 233 235 -1 232 235 234 -1 230 228 235 -1 230 235 233 -1 231 230 233 -1 231 233 232 -1 229 231 232 -1 229 232 234 -1 228 229 235 -1 229 234 235 -1 228 230 231 -1 228 231 229 -1 ] creaseAngle 0.2 } } ] } ] boundingObject Pose { translation -0.0075 -0.073 -0.016 children [ Box { size 0.027 0.113 0.036 } ] } physics Physics { density -1 mass 0.0592885 centerOfMass [ -0.00666564 -0.0458382 -0.0134901 ] inertiaMatrix [ 8.6855267e-05 2.1192085e-05 8.6845450e-05 -5.3020311e-06 -4.3636051e-07 -6.4855932e-06 ] } } } ] boundingObject Group { children [ Pose { translation 0 -0.019 0 children [ Box { size 0.036 0.044 0.04 } ] } Pose { translation 0 -0.06 0.003 children [ Box { size 0.036 0.036 0.051 } ] } ] } physics Physics { density -1 mass 0.168377 centerOfMass [ -0.000659787 -0.036239 0.000734065 ] inertiaMatrix [ 1.2202839e-04 3.8088441e-05 1.1340830e-04 2.0812626e-06 8.8143449e-07 1.8251448e-06 ] } } } ] name "shoulderR" boundingObject Pose { translation 0.009 -0.0065 0 rotation 0 0 1 0.785398 children [ Box { size 0.027 0.022 0.044 } ] } physics Physics { density -1 mass 0.025913 centerOfMass [ 0.00139 0.01352 0.01024 ] inertiaMatrix [ 9.7758165e-06 1.0511104e-05 5.4767980e-06 -1.6911839e-06 4.5174329e-07 3.3406955e-07 ] } } } DEF DHeadBackLED Pose { rotation 0.5774 0.5773 0.5773 2.0944 %< if (has_jersey) { >% translation -0.056 -0.01 -0.01 %< } else { >% translation -0.076 -0.01 -0.01 %< } >% children [ Shape { appearance PBRAppearance { baseColor 0.7 0.7 0.7 metalness 0 roughness 0.3 emissiveIntensity 6 } geometry Box { size 0.002 0.005 0.002 } } ] } DEF DEyeBackLED Pose { rotation 0.5774 0.5773 0.5773 2.0944 %< if (has_jersey) { >% translation -0.056 -0.015 -0.01 %< } else { >% translation -0.076 -0.015 -0.01 %< } >% children [ Shape { appearance PBRAppearance { baseColor 0.7 0.7 0.7 metalness 0 roughness 0.3 emissiveIntensity 6 } geometry Box { size 0.002 0.005 0.002 } } ] } ] boundingObject Group { children [ Pose { rotation 0.5774 0.5773 0.5773 2.0944 translation -0.025 0 -0.059 children [ Box { size 0.1 0.058 0.091 } ] } Pose { rotation 0.5774 0.5773 0.5773 2.0944 translation -0.038 0 -0.029 children [ Box { size 0.114 0.045 0.076 } ] } Pose { translation -0.027 0 -0.006 rotation 0.5957 0.5957 0.5389 2.1531 children [ Box { size 0.114 0.058 0.076 } ] } Pose { rotation 0.5774 0.5773 0.5773 2.0944 translation 0.028 0 -0.042 children [ Box { size 0.114 0.046 0.016 } ] } ] } name IS name model IS _model description IS _description physics Physics { density -1 mass 0.975599 centerOfMass [ -0.05 0.0 -0.08 ] inertiaMatrix [ 3.1081800e-03 6.3787776e-03 5.3316425e-03 -2.5460189e-04 2.0318174e-03 1.6417863e-04 ] } controller IS controller controllerArgs IS controllerArgs window IS window customData IS customData supervisor IS supervisor synchronization IS synchronization selfCollision IS selfCollision %< if (fields.window.value != "" && fields.window.value != "") { >% remoteControl "robotis-op2_tcpip" %< } >% } }