The motion module is run in its own thread with the highest priority on the robot, as joint angles need to be calculated at approximately 82 frames per second to maintain stability. The MotionAdapter class controls this thread and is the gateway for communicating in and out of the motion module. Within motion, there are 3 main areas.
receives input from Lola, eg gyroscopes, accelerometers, etc
generates joint values from the behaviour request and sensor input
outputs joint values to Lola
The most relevant report to motion currently is rUNSWift Walk2014 Report (Hengst, 2014)
Other reports that include motion concepts to varying degrees:
Learning to Control a Biped with Feet (Hengst, Lange, White, 2011)
Humanoid Omni-directional Locomotion (White, 2011)
Dynamic Omnidirectional Kicks on Humanoid Robots (Teh, 2012)
Bipedal walk and goalie behaviour in Robocup SPL (Liu, 2013)
rUNSWift Robocup SPL 2013 Special Project A Report (Padilha, 2013)
Most of the work in producing actions happens in the generator area. The main generator class is the DistributedGenerator that calls upon subsequent generators depending on the requested action. There are also some basic generators that all generated joints get passed through, such as the ClippedGenerator, which ensures that joint requests do not go past their maximum values.
All actions are defined in
$RUNSWIFT_CHECKOUT_DIR/robot/types/ActionCommand.hpp. If you do add
a new ActionType to it, remember to fill out all the corresponding
enums, such as the action’s priority. These priorities define what
actions can be interrupted, for example the get up action has the
To set a generator for a particular body action, you’ll need to add something like this to DistributedGenerator:
bodyGenerators[Body::BACK_FLIP] = (Generator*)(new BackFlipGenerator()); if (!bodyGenerators[Body::BACK_FLIP]) llog(FATAL) << "bodyGenerators[BACK_FLIP] is NULL!" << std::endl;
All generators should subclass the basic Generator.hpp class and fill in the virtual functions, such as isActive, reset, and stop. Along with the ActionCommand priorities, these functions help DistributedGenerator decide how and when to transition between different actions.
Static actions are typically used for straightforward motions such as
standing, squatting, diving and getups. These are handled by the
specify which action should be performed, the ActionGenerator is passed
the file name of the relevant .pos file.
The format for pos files are described in
They typically look like this, for eg.
HY HP LSP LSR LEY LER LWY LHYP LHR LHP LKP LAP LAR RHR RHP RKP RAP RAR RSP RSR REY RER RWY LH RH DUR $ 0 0 0 0 0 0 0 0.75 0.75 0.75 0.75 0.75 0.75 0.75 0.75 0.75 0.75 0.75 0 0 0 0 0 0 0 ! 0 0 90 10 0 0 0 0 0 -25 50 -25 0 0 -25 50 -25 0 90 -10 0 0 0 0 0 1000
All pos files can be found in
Dynamic actions are for more complicated movements, such as the walk and
kicks. Instead of reading the joint values from a pos file, they are set
in the relevant generator’s
Actions + Python¶
To add a new action into the Python code, you’ll need to add to the
python wrapping of ActionCommand in
Then add it to
For example here is the one for
def goalieDiveLeft(): return _type_only_body_command(robot.ActionType.GOALIE_DIVE_LEFT)
You will then be able to call your new action from a Python behaviour like so:
self.world.b_request.actions.body = actioncommand.goalieDiveLeft()
The motion module will know which behaviour is running as MotionAdapter.cpp will read it from the blackboard, and then call upon the appropriate generator.
// Get the motion request from behaviours int behaviourReadBuf = readFrom(behaviour, readBuf); ActionCommand::All request = readFrom(behaviour, request[behaviourReadBuf]).actions; ... ... ... // Get the joints requested by whichever generator we're using JointValues joints = generator->makeJoints(&request, &odometry, sensors, bodyModel, ball.x(), ball.y(), motionDebugInfo);
These can be found in perception (just a legacy location as it was originally only used for vision).
Modified DH parameters are used to calculate the forward kinematics chain. See Walk2014 Report for the Camera to Foot transform used in the Nao v4 (most of which is similar in the Nao v5 and v6) These are used for calculating the robot pose and converting camera image space co-ordinates to robot relative co-ordinates.
The DH parameters for each of Nao v4 limbs can be found in Bel Teh’s thesis (see Tables 3.1-3.3). These are used for calculating the centre of mass.
Note that body lean (as detected from IMU) is also applied when converting into world space as the robot’s foot is not always flat on the ground.
Both Kinematic Transforms and Iterative Inverse Kinematics for turning the feet can be found at the very bottom of Walk2014.cpp. They were copied from the symbolic Matlab solution and of the kinematic chain and iterative inverse method. Reference to the original work can be found in the 2010 rUNSWift Team Report in Chapter 6.
Walk2014 addresses shortcomings in the walk first developed in 2010,
Stability - addressed by a new Stabiliser using a reinforcement learnt policy and the Centre-of-Mass moved towards centre of foot.
Slow side-stepping - addressed with a new sidestepping generator that can take larger sidesteps.
Robots overheat - addressed by using a stand command with low stiffness.
Transition between stand, walks, kicks, and getup is not smooth - addressed by integrating these behaviour into the walk.
Acceleration and braking uses an inefficient ratcheting technique - addressed by ability to start and stop in one step. Forward is still limited to changes of e.g. 50mm / step, (built into walk).
Limited repertoire of kicks - addressed by new kicks, e.g. stab-kick, walk-kick, etc.
Walk2014 is more responsive than previous rUNSWift walks. Python roles and skills have more control (and hence responsibility) for parameter settings:
The forward, left and turn body action commands define the step-size (mm / rad) per second.
The user will need to ensure that the combination of forward/left/turn stays within the capability of the walk. However, the values have been clipped to +/- 300mm for forward, +/-200mm for left, and +/- 2.0 radian for turn. Please note that the above ranges for forward, left, turn are with only one parameter set, the others are zero). In combination these ranges will need to be reduced, but combinations have not all been tested.
Combination of parameter values are evaluated using an ellipsoid clamp, and transitions are dealt by clamping the maximum change of forward, left and turn.
Two Different Stand Postures¶
actioncommand.stand(power=stiffness) the walk performs a stand
routine and turns the stiffness to the motors using power. The power
parameter is optional and defaults to 0.1.
actioncommand.crouch(power=stiffness), the walk stops rocking, but is
READY for action i.e. legs are kept bent. Stiffness is kep to 0.4
minimum to ensure the robot retains this stance. The power parameter is
optional and defaults to 0.4.
However, there are some cases where the robot needs to stand but walk shouldn’t be running, for example when the robot first boots up or during ref pick up. We then use two pos files (initial.pos and stand.pos) that map to these two different stand postures.
The walk has been calibrated so that forward, left and turn will move
the real robot approximately the specified distance/angle in one second
in steady state operation. The odometry is calibrated based on foot
movements and should be more accurate than average parameter values. For
example, when changing speed, the odometry will record the movements at
82Hz and not use the parameter values. In the
// linear calibration to achieve actual performance ie turn in action command achieves turn/sec in radians on the robot forward *= 1.0; left *= 0.82; turn *= 0.78;
The standard kick is also integrated into Walk2014Generator to make transitioning between the two as smooth as possible. It uses many of the same parameters and calculations.
The motion of the kick is defined in several phases:
The back phase moves the foot backwards in preparation for the kick swing. It also moves the foot sideways depending on the position of the ball. This dynamic left movement helps reduce time spent lining up. The power parameter is used at this stage to affect how far back the kick foot should go back.
The kick swing phase swings the foot forward into the ball. The power parameter is used at this stage to affect how far forwards the kick foot travels forwards.
The follow through phase holds and stabilises at the end of the kick swing.
The end phase returns the foot back to the zero position.
Since the behaviour module runs at 30fps in a separate thread and does not have access to the state of the walk cycle found in walk generator, it has no precise way to tell when a step begins and when it ends. That’s why walk parameters are given as step size per second. However, this makes certain higher level behaviours difficult when precision of steps is required, such as lining up to the ball before kicking it.
The walk preprocessor is a wrapper around the walk generator and has access to the state of the walk cycle. It breaks down a single higher level behaviour request into multiple walk parameters for the walk generator. Thus avoiding the need for synchronisation between the behaviour and motion thread, and ensures precision of steps.
This was used to perform a motion line up and turn dribble, but both are outdated and unused.