Changes between Version 55 and Version 56 of Tutorials

Timestamp:

Apr 11, 2016, 10:33:13 AM (10 years ago)

Author:

fma

Comment:

--

Tutorials

@@ -308 +308 @@
 #!python
 
-}}}
-
+#!/usr/bin/env python
+# -*- coding: utf-8 -*-
+
+import math
+
+import visual
+
+from py4bot.api import *
+
+import settings
+}}}
+
+Nothing fancy, here.
+
+{{{
+#!python
+
+class Hexapod3D(Robot3D):
+    def _createBody(self):
+        return Body(settings.LEGS_ORIGIN)
+
+    def _createLegs(self):
+        legs = {}
+        legIk = {}
+        for legIndex in settings.LEGS_INDEX:
+            legs[legIndex] = Leg3Dof(legIndex, {'coxa': Coxa(), 'femur': Femur(), 'tibia': Tibia()}, settings.FEET_NEUTRAL[legIndex])
+            legIk[legIndex] = Leg3DofIk(settings.LEGS_GEOMETRY[legIndex])
+
+        return legs, legIk
+}}}
+
+Same as before, except that we inherits from {{{Robot3D}}}, instead of {{{Robot}}}. 
+
+{{{
+#!python
+
+    def _createActuatorPool(self):
+        driver = Driver3D()
+        pool = ActuatorPool(driver)
+
+        num = 0
+        for leg in self._legs.values():
+
+            # Create joints actuators
+            coxa3D = Coxa3D(leg.coxa, num, settings.LEGS_GEOMETRY[leg.index]['coxa'])
+            pool.add(coxa3D)
+            num += 1
+
+            femur3D = Femur3D(leg.femur, num, settings.LEGS_GEOMETRY[leg.index]['femur'])
+            pool.add(femur3D)
+            num += 1
+
+            tibia3D = Tibia3D(leg.tibia, num, settings.LEGS_GEOMETRY[leg.index]['tibia'])
+            pool.add(tibia3D)
+            num += 1
+
+            # Init 3D view
+            coxa3D.frame = self._body3D
+            femur3D.frame = coxa3D
+            tibia3D.frame = femur3D
+
+            coxa3D.pos = (settings.LEGS_ORIGIN[leg.index]['x'], 0, -settings.LEGS_ORIGIN[leg.index]['y'])
+            femur3D.pos = (settings.LEGS_GEOMETRY[leg.index]['coxa'], 0, 0)
+            tibia3D.pos = (settings.LEGS_GEOMETRY[leg.index]['femur'], 0, 0)
+
+            coxa3D.rotate(angle=math.radians(settings.LEGS_ORIGIN[leg.index]['gamma0']), axis=(0, 1, 0))
+
+        return pool
+}}}
+
+Here, we use specific 3D actuators: {{{Coxa3D}}}, {{{Femur3D}}}, {{{Tibia3D}}}; they all use the [http://vpython.org VPython] library to represent themselves on the screen.
+
+Note that we don't use a custom actuator mapping; nums are automatically incremented.
+
+We also need to configure the hierarchy, and the relative positions of the actuators.
+
+''Note: this may change in the future; I'm working on a simpler way to do all this''.
+
+{{{
+#!python
+
+class Gamepad(RemoteControl):
+    def _createFrontend(self):
+        return Thrustmaster(settings.THRUSTMASTER_PATH)
+
+    def _buildComponents(self):
+        self._addConfig("walk")
+        self._addConfig("body")
+
+        self._addComponent(Button, command=self.selectNextConfig, key="button_08", trigger="hold")
+        self._addComponent(Button, command=self.selectPreviousConfig, key="button_09", trigger="hold")
+
+        self._addComponent(Button, command=self.robot.incBodyPosition, key="button_004", mapper=MapperSetValue(dz=+5))
+        self._addComponent(Button, command=self.robot.incBodyPosition, key="button_005", mapper=MapperSetValue(dz=-5))
+        self._addComponent(Joystick, configs="walk", command=GaitSequencer().walk, keys=("analog_02", "analog_03", "analog_00"), mapper=MapperWalk())
+
+        self._addComponent(Analog, configs="body", command=self.robot.setBodyExtraPosition, key="analog_00", mapper=MapperSetMultiply('yaw', coef=-15))
+        self._addComponent(Analog, configs="body", command=self.robot.setBodyExtraPosition, key="analog_03", mapper=MapperSetMultiply('pitch', coef=-15))
+        self._addComponent(Analog, configs="body", command=self.robot.setBodyExtraPosition, key="analog_02", mapper=MapperSetMultiply('roll', coef=15))
+}}}
+
+Same as before...
+
+{{{
+#!python
+
+def main():
+    scene = visual.display(width=settings.SCENE_WIDTH, height=settings.SCENE_HEIGHT)
+    ground = visual.box(axis=(0, 1, 0), pos=(0, 0, 0), length=0.1, height=500, width=500, color=visual.color.gray(0.75), opacity=0.5)
+
+    def addGait(gaitClass, gaitName):
+        gait = gaitClass(gaitName, settings.GAIT_LEGS_GROUPS[gaitName], settings.GAIT_PARAMS[gaitName])
+        GaitManager().add(gait)
+
+    addGait(GaitTripod, "tripod")
+    addGait(GaitTetrapod, "tetrapod")
+    addGait(GaitRiple, "riple")
+    addGait(GaitWave, "metachronal")
+    addGait(GaitWave, "wave")
+    GaitManager().select("riple")
+
+    robot = Hexapod3D()
+
+    remote = Gamepad(robot)
+
+    GaitSequencer().start()
+    remote.start()
+
+    robot.setBodyPosition(z=30)
+
+    robot.mainLoop()
+
+    remote.stop()
+    remote.join()
+    GaitSequencer().stop()
+    GaitSequencer().join()
+
+if __name__ == "__main__":
+    main()
+}}}
+
+The only difference, here, is the scene size init, and the ground addition (optional).
 === Settings ===