We present a real-time algorithm which can recover the 3D trajectory of a monocular camera, moving rapidly through a previously unknown scene. Our system, which we dub MonoSLAM, is the first successful application of the SLAM methodology from mobile robotics to the "pure vision" domain of a single uncontrolled camera, achieving real time but drift-free performance inaccessible to structure from motion approaches. The core of the approach is the online creation of a sparse but persistent map of natural landmarks within a probabilistic framework. Our key novel contributions include an active approach to mapping and measurement, the use of a general motion model for smooth camera movement, and solutions for monocular feature initialization and feature orientation estimation. Together, these add up to an extremely efficient and robust algorithm which runs at 30 Hz with standard PC and camera hardware. This work extends the range of robotic systems in which SLAM can be usefully applied, but also opens up new areas. We present applications of MonoSLAM to real-time 3D localization and mapping for a high-performance full-size humanoid robot and live augmented reality with a hand-held camera

/pdf/monoslam-real-time-single-camera-slam-ydmj8dc1vj.pdf

MonoSLAM: Real-Time Single Camera SLAM

We introduce a new method of a biped walking pattern generation by using a preview control of the zero-moment point (ZMP). First, the dynamics of a biped robot is modeled as a running cart on a table which gives a convenient representation to treat ZMP. After reviewing conventional methods of ZMP based pattern generation, we formalize the problem as the design of a ZMP tracking servo controller. It is shown that we can realize such controller by adopting the preview control theory that uses the future reference. It is also shown that a preview controller can be used to compensate the ZMP error caused by the difference between a simple model and the precise multibody model. The effectiveness of the proposed method is demonstrated by a simulation of walking on spiral stairs.

/pdf/biped-walking-pattern-generation-by-using-preview-control-of-84qdve2k8v.pdf

Biped walking pattern generation by using preview control of zero-moment point

From exploring planets to cleaning homes, the reach and versatility of robotics is vast. The integration of actuation, sensing and control makes robotics systems powerful, but complicates their simulation. This paper introduces a versatile, scalable, yet powerful general-purpose robot simulation framework called V-REP. The paper discusses the utility of a portable and flexible simulation framework that allows for direct incorporation of various control techniques. This renders simulations and simulation models more accessible to a general-public, by reducing the simulation model deployment complexity. It also increases productivity by offering built-in and ready-to-use functionalities, as well as a multitude of programming approaches. This allows for a multitude of applications including rapid algorithm development, system verification, rapid prototyping, and deployment for cases such as safety/remote monitoring, training and education, hardware control, and factory automation simulation.

V-REP: A versatile and scalable robot simulation framework

It is known that for a large magnitude push a human or a humanoid robot must take a step to avoid a fall. Despite some scattered results, a principled approach towards "when and where to take a step" has not yet emerged. Towards this goal, we present methods for computing capture points and the capture region, the region on the ground where a humanoid must step to in order to come to a complete stop. The intersection between the capture region and the base of support determines which strategy the robot should adopt to successfully stop in a given situation. Computing the capture region for a humanoid, in general, is very difficult. However, with simple models of walking, computation of the capture region is simplified. We extend the well-known linear inverted pendulum model to include a flywheel body and show how to compute exact solutions of the capture region for this model. Adding rotational inertia enables the humanoid to control its centroidal angular momentum, much like the way human beings do, significantly enlarging the capture region. We present simulations of a simple planar biped that can recover balance after a push by stepping to the capture region and using internal angular momentum. Ongoing work involves applying the solution from the simple model as an approximate solution to more complex simulations of bipedal walking, including a 3D biped with distributed mass.

/pdf/capture-point-a-step-toward-humanoid-push-recovery-12jssfk8t5.pdf

Capture Point: A Step toward Humanoid Push Recovery

For 3D walking control of a biped robot we analyze the dynamics of a 3D inverted pendulum in which motion is constrained to move along an arbitrarily defined plane. This analysis yields a simple linear dynamics, the 3D linear inverted pendulum mode (3D-LIPM). Geometric nature of trajectories under the 3D-LIPM and a method for walking pattern generation are discussed. A simulation result of a walking control using a 12-DOF biped robot model is also shown.

The 3D linear inverted pendulum mode: a simple modeling for a biped walking pattern generation

A novel control method for biped locomotion on rugged terrain is introduced, assuming an ideal robot model which has massless legs. By applying constraint control to the robot body so that it moves on a particular straight line and rotates at a constant angular velocity, the dynamics of the center of mass of the body becomes completely linear. Such motion of the ideal model is called the linear inverted pendulum mode, and it is used to develop the control scheme of the biped walking on rugged terrain. Under the control method in the linear inverted pendulum mode, walking on a particular rugged ground is shown to be equivalent to walking on a level ground. It is also shown that the additional use of the ankle torque makes the proposed control scheme robust and applicable to a real biped robot with mass legs. Simulation results are presented. >

Study of dynamic biped locomotion on rugged terrain-derivation and application of the linear inverted pendulum mode

A novel framework of biped walking stabilization control is introduced. The target robot is a 42 DOF humanoid robot HRP-4C which has a body dimensions close to the average Japanese female. We develop a body posture controller and foot force controllers on the joint position servo of the robot. By applying this posture/force control, we can regard the robot system as a simple linear inverted pendulum with ZMP delay. After a preliminary experiment to confirm the linear dynamics, we design a tracking controller for walking stabilization. It is evaluated in the experiments of HRP-4C walking and turning on a lab floor. The robot can also perform an outdoor walk on an uneven pavement.

/pdf/biped-walking-stabilization-based-on-linear-inverted-5faxgmzjxa.pdf

Biped walking stabilization based on linear inverted pendulum tracking

To reduce the complex walking dynamics of a biped, a particular class of trajectories of an ideal biped model where the center of gravity of the body moves horizontally and the horizontal motion of the center of gravity can be expressed by a simple linear differential equation is introduced. The authors coin the phrase 'potential energy conserving orbit' to describe this class of trajectories. Based on these properties, control laws were formulated for walk initiation, walk continuation, and walk termination. The walking motion is controlled by support leg exchange. Robust realization of the walking control is also considered. An experimental walking machine was designed as a nearly ideal biped model. To make the legs lighter, four DC motors were mounted in the body, and the legs are parallel link structures. The results of the experiment describe five steps of dynamic walking including walk initiation. >

Dynamic walking control of a biped robot along a potential energy conserving orbit

For real-time walking control of a biped robot, we analyze the dynamics of a three-dimensional inverted pendulum whose motions are constrained onto an arbitrarily defined plane. This analysis leads us a simple linear dynamics, the Three-Dimensional Linear Inverted Pendulum Mode (3D-LIPM). Geometric nature of trajectories under the 3D-LIPM is discussed, and an algorithm for walking pattern generation is presented. Experimental results of real-time walking control of a 12-DOF biped robot HRP-2L using an input device such as a game pad are also shown.

/pdf/a-realtime-pattern-generator-for-biped-walking-52gs79h95z.pdf

A realtime pattern generator for biped walking

This paper presents a prototype humanoid robotics platform developed for HRP-2. HRP-2 is a new humanoid robotics platform, which we have been developing in phase two of HRP HRP is a humanoid robotics project, which has been launched by Ministry of Economy, Trade and Industry (METI) of Japan from 1998FY to 2002FY for five years. The ability of the biped locomotion of HRP-2 is improved so that HRP-2 can cope with rough terrain in the open air and can prevent the possible damages to a humanoid robot's own self in the event of tipping over. The ability of whole body motion of HRP-2 is also improved so that HRP-2 can get up by a humanoid robot's own self even tough HRP-2 tips over. In this paper, the mechanisms and specifications of developed prototype humanoid robotics platform, and its electrical system are introduced.

/pdf/design-of-prototype-humanoid-robotics-platform-for-hrp-2v0q56zyow.pdf

Shuuji Kajita

Papers

Study of dynamic biped locomotion on rugged terrain-derivation and application of the linear inverted pendulum mode

Biped walking stabilization based on linear inverted pendulum tracking

Dynamic walking control of a biped robot along a potential energy conserving orbit

A realtime pattern generator for biped walking

Design of prototype humanoid robotics platform for HRP