Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals

Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals

Christoph Gebhardt222The first two authors contributed equally to this work. , Benjamin Hepp222The first two authors contributed equally to this work. , Tobias Nägeli, Stefan Stevšić, Otmar Hilliges
Departement of Computer Science, AIT Lab
ETH Zürich
Abstract

In this paper we propose a computational design tool that allows end-users to create advanced quadrotor trajectories with a variety of application scenarios in mind. Our algorithm allows novice users to create quadrotor based use-cases without requiring deep knowledge in either quadrotor control or the underlying constraints of the target domain. To achieve this goal we propose an optimization-based method that generates feasible trajectories which can be flown in the real world. Furthermore, the method incorporates high-level human objectives into the planning of flight trajectories. An easy to use 3D design tool allows for quick specification and editing of trajectories as well as for intuitive exploration of the resulting solution space. We demonstrate the utility of our approach in several real-world application scenarios, including aerial-videography, robotic light-painting and drone racing.

Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals

Christoph Gebhardt222The first two authors contributed equally to this work. , Benjamin Hepp222The first two authors contributed equally to this work. , Tobias Nägeli, Stefan Stevšić, Otmar Hilliges
Departement of Computer Science, AIT Lab
ETH Zürich
Figure \thefigure: Interactive computational design of quadrotor trajectories: (A) user interface to specifiy keyframes and dynamics of quadrotor flight. (B) An optimization algorithm generates feasible trajectories and (C) a 3D preview allows the user to quickly iterate on them. (D) The final motion plan can be flown by real quadrotors. The tool enables the implementation of a number of compelling use cases such as (B) robotic light-painting, aerial racing and (D) aerial videography.
\@float

copyrightbox[b]

\end@float

robotics; quadrotors; computational design; videography

I.2.9 Robotics: Autonomous vehicles; Operator interfaces; H.5.2 User Interfaces;

In recent years micro-aerial vehicles (MAVs), in particular Quadrotors, have seen a rapid increase in popularity both in research and the consumer mainstream. While the underlying mechatronics and control aspects are complex, the recent emergence of simple to use hardware and easy programmable software platforms has opened the door to widespread adoption and enthusiasts have embraced MAVs such as the AR.Drone or DJI Phantom in many compelling scenarios including aerial photo- and videography. Furthermore, the HCI community has begun to explore these drones in interactive systems such as sports assistants [?, ?, ?] or display [?] of content.

Clearly there is a desire to use such platforms in a variety of application scenarios. Current SDKs already give novices access to manual or waypoint based control of MAVs, shielding them from the underlying complexities. However, this simplicity comes at the cost of flexibility. For instance, flying a smooth, spline-like trajectory or aggressive flight maneuvers, for example to create an aerial light show (e.g., [?, ?]), is tedious or impossible with waypoint based navigation. These limits exist because manufacturers place hard thresholds on the dynamics to ensure flight stability for inexperienced pilots.

More importantly, state-of-the-art technologies offer only very limited support for users who want to employ MAVs to reach a certain high-level goal. This is maybe best illustrated by the most successful application area – that of aerial videography. What a few years ago was limited to professional camera crews, requiring cost-intensive equipment like a helicopter, can now, in principle, be done by end-users with a MAV and an action camera. However, producing high-quality aerial footage is not an easy task – it demands attention to the creative aspects of videography such as frame composition and camera motion (cf. [?]). In the case of airborne cameras, an operator needs to fly smoothly, accurately and safely around a camera target. Furthermore, the target has to be framed properly alongside further creative considerations. Thus this is a difficult task and typically requires at least two experienced operators – one pilot and a camera man (cf. [?]). Our method tackles this problem by enabling a single novice user to fly challenging trajectories and still create aesthetically pleasing aerial footage.

Figure \thefigure: System workflow schematically. (1) User sketches keyframes. (2) An optimization method generates a feasible trajectory. (3+4) The user can quickly iterate over the trajectory and explore the solution space of feasible trajectories via a physics simulation or a rendered preview (see Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals, D). (5) Final trajectory can be flown with a real MAV.

Embracing the above challenges we propose a computational method that enables novice end-users to create quadrotor use-cases without requiring expertise in either low-level quadrotor control or specific knowledge in the target domain. The core contribution of our method is an optimization-based solution that generates feasible trajectories for flying robots while taking high-level user goals such as visually pleasing video shots, optimal racing trajectories or aesthetically pleasing MAV motion into consideration. Furthermore, we develop an easy-to-use tool that allows for straightforward specification of flight trajectories and high-level constraints. Our approach guides the users in exploring the resulting design space via a 3D user interface and allows for quick iteration until finding a solution which fits best with the user’s intentions.

We demonstrate the flexibility of our approach in three real-world scenarios including aesthetically pleasing aerial-videos, robotic light-painting and drone racing.

With MAVs becoming consumerized the HCI community has begun to explore this design space. FollowMe [?] is a MAV that follows a user and detects simple gestures via a depth camera, whereas others have proposed using head motion for MAV control [?], while [?] propose a simple, remote controlled flying projection platform. Several setups have been proposed that turn such MAVs into flying, personal companions. For example, to act as jogging partner [?] or general purpose sports coach [?], or as an actuated and programmable piece of sports equipment [?].

Commercially available drones, targeted at the consumer market, shield the user form low-level flight aspects and provide simple manual control (e.g. using smartphones as controller) or waypoint based programmatic navigation as well as GPS based person following. This dramatically lowers the entry barrier for novices but also limits the ceiling of achievable robotic behavior. Our approach also aims for simplicity but gives more power to the users, enabling even novices to design and implement complex flight trajectories, concentrating on the high-level goals of the application domain.

Improving the visual quality of end-user produced content is a goal we share with post production video stabilization. Inspired by early work which formulates the problem and discusses the aesthetics of cinematography [?] a number of approaches employ computer vision methods to estimate the original, jerky camera path. Based on this a new, smooth path is computed to generate stabilized video [?, ?] and even time-lapse footage [?] from the source material. Camera path planning has also been studied extensively in the context of virtual environments using constraint based [?, ?] or probabilistic [?] methods. However, these methods are not limited by real-world physics and hence can produce arbitrary camera trajectories and viewpoints. Our approach differs from the above as we propose a forward method that gives the user full control over the creative aspect of camera planning while simultaneously optimizing for physical feasibility of the flight path and cinematographic objectives. A 3D simulation lets the user explore the design space before flying the actual trajectory and hence helps in understanding the trade-offs to consider.

Sharing the goal of unlocking areas that previously required significant domain knowledge to novice users, the HCI and graphics communities have proposed several methods that give novice users control over aesthetic considerations while achieving functionality. Recent examples include digitally designed gliders [?] and kites [?] with optimized aerodynamic properties. At the core of these approaches are sophisticated simulations or analytical models of the problem domain that carefully balance accuracy and rapid responses to ensure interactivity while maintaining guarantees (e.g., physical stability). We build on domain knowledge from the robotics and MAV literature and propose an interactive design tool for complex MAV behavior usable by non-experts.

Automating the design of robotic systems based on high-level functional specifications is a long-standing goal in robotics, graphics and HCI. Focussing on robot behavior only, simple direct touch and tangible UIs [?], and sketch based interfaces to program robotic systems [?, ?] have been proposed. Visual markers have been used to control robots explicitly, for example as kitchen aides [?], or implicitly [?, ?], to schedule tasks for robots in-situ which are then collected and executed asynchronously.

Generating flight trajectories for MAVs is well-studied in robotics. In particular, the control aspects of aggressive and acrobatic flight is an active area of research (e.g., [?]). Mellinger et al.’s work on generating minimum snap trajectories [?] is the most related to ours. While they specify a trajectory as a piecewise polynomial spline between keyframes, we discretize the trajectory into small piecewise linear steps. The result is a more intuitive formulation of the optimization problem, making the incorporation of additional constraints and objectives much easier. We extend the approach in [?] by optimizing trajectories for flyability and for high-level human objectives. We place the users in the loop and provide easy-to-use tools to design quadrotor trajectories according to high-level objectives.

Joubert et al. [?] share a similar goal in proposing a design tool that allows novice users to specify a camera trajectory, simulate the result, and execute the motion plan. In contrast to our work, their method does not automate feasibility checking but delegates the correction of violations to the user. Furthermore, our method allows to treat keyframes as soft instead of hard constraints, allowing to trade off feasibility against keyframe matching. We also incorporate a larger number of high-level user constraints, such as additional cinematographic goals and collision-free trajectories, into the algorithm – requiring a different formulation of the optimization problem. Finally, we demonstrate the gain in generality in our approach in the additional use cases of light writing and aerial racing.

We propose an end-to-end system that allows users to generate motion plans for quadrotors that are ’flyable’ and adhere to high-level human-specified objectives for a variety of application scenarios. Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals illustrates the design process.

Using for example a LeapMotion controller the user specifies keyframes, each consisting of a position and a time (1). The optimization algorithm generates an initial ’flyable’ trajectory from these inputs, i.e., one that lies within the physical capabilities of the underlying quadrotor hardware (2). The method aims to find a solution that goes through all specified keyframes, however the user may now adjust both a keyframe’s position and timing as well as other parameters such as the overall flight time, the optimization’s objective (e.g., minimization of velocity) or the extend to which the generated trajectory should follow the optimization’s objective versus the position of the specified keyframes (3). This can result in trajectories that do not directly meet the user inputs but are the best trade-off between the potentially conflicting use-case specific constraints. A built-in physics simulation allows the user to virtually fly the quadrotor and thus provides a better understanding of the expected real-world behavior and enables rapid iteration of trajectories (4). This tool already enables the design of various flight-maneuvers for example designing an aerial race-course or a light-show (please see video for an illustration of the design process and results).

Figure \thefigure: Planning of aerial video shots. (A) User specifies sparse keyframe positions connected by straight lines (purple). (B) For each keyframe the user also specifies a desired camera target (yellow). (C) We generate a smooth and collision free motion plan alongside gimbal control inputs (dark red). (D) Virtual preview allows for rapid prototyping showing the current camera frustum and a camera preview.

However, the goal of our work is to enable more complex end-user scenarios as well. To this end we have extended our method to also integrate high-level aesthetic constraints that are not necessarily directly associated with the basics of quadrotor control. Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals illustrates how our tool can be used to plan aerial videography shots. In this case, the user designs an initial camera trajectory around one or several targets. In addition to the keyframes the user specifies targets which shall be captured by the on-board camera (Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals, B). Our algorithm generates both a quadrotor trajectory and a gimbal trajectory within the physical bounds. To acquire visually pleasing footage our method incorporates cinematographic constraints such as smooth camera and target motion, smooth transitions between multiple targets and reduction of perspective distortions. Furthermore, the algorithm takes obstacle information into account and automatically routes the trajectory through free-space (see Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals, C). It would also be straightforward to integrate other constraints such as limits of the coverage of a tracking system or government flight regulations.

In order to better understand the implications of the camera planning our tool allows the user to virtually fly the shot by dragging the virtual quadrotor along the trajectory (Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals, D). For each point in time the tool renders the scene as it would be captured in reality. The user can then edit the plan and iterate over different alternatives. Once satisfied the generated trajectories for quadrotor and gimbal can be deployed as a reference to be followed by a real quadrotor.

So far we have discussed the proposed design tool at a high-level and focused on how the user accomplishes certain tasks.

We now introduce the underlying method we use to generate trajectories. To be able to reason about flight plans computationally, a model of the quadrotor and its dynamics are needed. This is a complex and challenging topic and we refer the reader to the Appendix for the full non-linear model that is needed to control the position and dynamics of the robot during flight (please see also [?]). The full model directly relates the inputs of a quadrotor to its dynamics – this however makes trajectory generation a challenging problem and integrating such a highly non-linear model into an optimization scheme is complicated, incurs high computational cost and negates convergence guarantees [?]. However, for most application scenarios considered here a full non-linear treatment is not necessary as demonstrated by our results. In particular if the goal is to generate trajectories only (i.e., position and velocities) rather than the full control inputs as in [?]. Therefore, we present a linear approximative model of the quadrotor and detail the optimization-based algorithm based on it.

Figure \thefigure: Our approximated quadrotor model with position , yaw angle ), world frame (, , ), the moment acting on the quadrotor along the world frame z-axis and the force acting on the center of mass of the quadrotor.

When generating a trajectory we want to ensure that it can be followed by a quadrotor, i.e. a flight plan where each specified position and velocity can be reached within the time limits without exceeding the limits of the qudrotors inputs.

Therefore, we chose to approximate the quadrotor as a rigid body, described by its moment of inertia only along the world frame z-axis (i.e. we ignore pitch and roll of the quadrotor):

(1)

where describes the center of mass of the quadrotor, is the yaw angle of the quadrotor, is the mass of the quadrotor, is the moment of inertia about the body-frame z-axis, is the the force acting on the quadrotor and is the torque along the z-axis. This approximation allows to generate trajectories in the flat output space of the full quadrotor model (see Appendix for more details).

In addition to the equations of motion we introduce bounds on the maximum achievable force and torque:

(2)

where is the input of the system.

With this model it is not possible to exploit the full dynamic agility of a quadrotor. As an example, consider the situation of accelerating straight upwards by rotating all motors at maximum speed. To now also rotate around the body-frame z-axis we would have to lower the speed of motors and , reducing the total thrust of the quadrotor. Currently we do not incorporate this coupling between the translational and rotational dynamics into the bounds Eq. (2) of our approximate linear model Eq. (Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals). Therefore, to still ensure that a quadrotor can follow trajectories generated on base of this approximation conservative bounds are required. Nonetheless, our results and applications demonstrate that these bounds still allow the quadrotor’s agility to be sufficiently rich for many use cases. We refer the interested reader to the Appendix for details on how to choose these bounds.

For trajectory generation we rewrite the approximate model as a first-order dynamical system and discretize it in time with a time-step assuming a zero-order hold strategy, i.e. keeping the inputs constant in between stages:

(3)

where is the state and is the input of the system at time . The matrix propagates the state forward by one time-step, the matrix describes the effect of the input on the state and the vector that of gravity after one time-step.

With this approximate quadrotor model in place we can now discuss the optimization scheme to generate trajectories. The user specifies keyframes describing a desired position at a specific time-point , where maps the index of the keyframe to the corresponding time-point. In the case of mouse-based user input we assume constant time between consecutive positions. To compute a feasible trajectory over the whole time horizon we discretize time with a time-step into stages. The variables we optimize for are the quadrotor state and the inputs of the system Eq. (3) at each stage .

The first goal of our optimization scheme is then to follow the user inputs as closely as possible, expressed by the cost

(4)

A small residual of indicates a good match of the planned quadrotor position and the specified keyframe. The bounds Eq. (2) together with Eq. (3) and Eq. (4) can then be formulated as a quadratic program

(5)
subject to
and

where denotes the stacked state vectors and inputs for each time-point, and contain the quadratic and linear cost coefficients respectively which are defined by Eq. (4) , , comprise the linear inequality constraints of the inputs Eq. (2) and , are the linear equality constraints from our model Eq. (3) for each time-point . This problem has a sparse structure and can be readily solved by most optimization software packages. However, this problem is ill-posed and the result for a particular set of keyframes might be counterintuitive at first. Since we only measure the match of quadrotor position at the keyframe times the state at other time-points is not constrained in any way except for the quadrotor dynamics. Therefore a straight path between two keyframe positions is as good as a zig-zag pattern if it is feasible. An example of this is shown in Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals. To attain better results we have to further regularize the solution.

Figure \thefigure: Same trajectory, optimized to only follow the keyframes (A) and to follow keyframes as well as minimizing snap on each stage of the optimization problem (B).

In many robotics application one goal is to minimize energy expenditure and this is often done by penalizing non-zero inputs or in other words attempting to reach desired positions with minimal wasted effort. For end-user applications, for example in the context of a racing game, one can also aim to attain smooth trajectories by penalizing higher derivatives of the quadrotor’s position with respect to time such as acceleration (2nd) or jerk (3rd). We introduce the cost

(6)

where is a finite-difference approximation of the -th derivative from the last states. Since the term jerk is not commonly known outside of engineering fields an intuition is to think of high values of jerk as a feeling of discomfort caused by too sudden motion. Humans tend to plan motion by minimizing the norm of jerk [?] and thus, minimizing jerk results in motion plans that appear pleasant to a human.

The combined cost with weights is still a quadratic program and enables us to generate trajectories that are feasible and that are optimal in the sense of Eq. (5). While still relatively basic in functionality this already enables a variety of use-cases such as aerial light-shows and racing-games as illustrated in the next section.

With the basics in place we now turn our attention to including high-level human objectives into the optimization. As a running example we will consider the task of planning an aerial video-shot but we would like to emphasize that many other tasks such as 3D reconstruction or projector based augmented reality could be implemented in the same way.

We have already discussed how this process works from the user’s perspective in the system overview. Here the user provides additional camera targets that should be recorded at a specific time (see Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals). Furthermore, we assume that the quadrotor is equipped with a gimbal that we can control programmatically. From a cinematographic standpoint, the most pleasant viewing experience is conveyed by the use of either static cameras, panning ones mounted on tripods or cameras placed onto a dolly (cf. [?]). Changes between these shot types can be obtained by the introduction of a cut or jerk-free transitions, i.e. avoiding sudden changes in acceleration. Furthermore, it is desirable to introduce saliency constraints or in other words we want not only the camera path to be smooth but also want to keep the target motion within the image frame as steady as possible and constrain it’s motion to smooth motion.

Figure \thefigure: (A) camera direction and distance . (B) effect of minimizing camera angle error w.r.t. the target in the center of the FOV of the camera.

To achieve these high-level objectives, we include a target position for each stage into the optimization variable. Analogous to the quadrotor position we introduce a cost term that measures the deviations of user-specified keytarget points from the target positions at the corresponding stages. We penalize higher temporal derivatives (acceleration and jerk) of the target position by including finite differences in the cost term . To link the quadrotor and target trajectories we introduce a simple gimbal model:

where the inputs , represent the angular velocities of the yaw and pitch of the gimbal and both the inputs and the absolute angles are bounded according to the physical gimbal. The bounds specify the limits on the absolute angles and the angular velocities. To ensure a smooth motion of the gimbal we introduce a cost on temporal finite differences of the yaw and pitch angles analogous to Eq. (6). We do not incorporate the attitude of the quadrotor into our gimbal model and therefore the bounds have to be chosen conservatively.

The angle between the current camera direction and the direction of the target is depicted in Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals. The error is then computed by

(7)

where is the quadrotor position, is the target position and is the pitch angle of the quadrotor.

Deviations of the camera direction from the desired target are penalized by

(8)

where is the camera angle error at stage . Here the separation of target trajectory from the camera direction might seem surprising but it gives more flexibility as the user can choose the weights of the importance of target keypoints and the camera direction separately.

Figure \thefigure: (A) Illustration of skewness error, where and are the distances to the upper and lower edge of the target bounding box. (B+C) Perspective without skewness correction (B) and with (C). Note that target is centered in both images.

The final aesthetic cost is related to perspective effects. Viewpoints that are to high or low relative to the recorded object of interest lead to skew and results in strong vanishing lines in the image. This is illustrated in Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals. While this effect maybe desired in some situations (imagine an overhead shot) we allow the user to supress these types of distortions by optionally including a skewness cost :

(9)

where is a vertical vector pointing from the center of the target to the upper edge of the bounding box and is the skewness error at stage . In the computation we distinguish the case of a quadrotor flying above the target and the case of flying below a target.

Summing up the individual cost terms gives results in the final cost Unfortunately and are non-linear in the variables of the motion plan and in consequence minimizing can no longer be written as a quadratic program. We describe how we minimize in the implementation section.

By penalizing snap of the quadrotor position and jerk of the camera motion the combined cost results in aesthetically pleasing footage (see the accompanying video). We can now generate a motion plan for a quadrotor that follows a target trajectory with the camera. To further support novice users we included an approximate collision-free scheme that can be used to keep a minimum distance from the target or stay at a safe distance from obstacles. Again we refer to the implementation section for details. Note that this only works for static objects where the position is known at the time of trajectory generation.

In this section we describe how we implemented the different components of our system. We start with describing the iterative quadratic programming scheme, then explain the onboard controller and the quadrotor hardware and finally show how we realized the design tool.

Figure \thefigure: Aerial camera shot of a toy castle. Top row: planned trajectory in our design tool. Bottom row: flown trajectory.

To solve the non-linear problem described above we resort to a scheme of iterative quadratic programming (IQP). The general idea is to linearly or quadratically approximate the problem around the current estimate of the solution. This approximate system is then solved and a better, consistent estimate of the solution is found. These iterative schemes usually converge within a few iterations despite the cost functions not being convex anymore. In our concrete implementation we start with an initial guess of the trajectory by interpolating the quadrotor positions and the camera targets between the keyframes. We also enforce all initial equality constraints to be fulfilled. As the proposed energies are usually non-convex a good initial guess is important to find a good solution. For each major iteration of our solver we build the and matrices of a quadratic program. This is done by quadratically approximating each of the cost terms around the trajectory , note that this does not affect the quadratic terms in . We also assemble the bounds and equality and inequality constraints and linearize them analogously. The fully assembled system is a sparse quadratic program and can be solved by most optimization packages. The solution gives us a change of the current motion plan. We perform a line search with the step length to find a new motion plan . We lower until we find a with a cost . This step is necessary as the cost of the approximated quadratic program is only an approximation of the real residual. An empirically derived serves as termination criteria.

We approximate each obstacle as a static sphere with a radius and introduce a non-convex constraint . We linearize these constraints in each IQP iteration for each stage in time around the current trajectory . Although we cannot guarantee global optimality of the resulting trajectories, this approach can be helpful for planning trajectories in scenes with known geometry and many objects. More advanced collision avoidance schemes, potentially taking dynamic targets into consideration (e.g., [?]), could be included in future work.

To evaluate the performance of our optimization scheme we measured the time necessary to generate different trajectories. The runtime of the algorithm depends on the flight duration, the number of keyframes and the constraints which are incorporated into the optimization problem. Typical run times (Intel Core i7 4GHz CPU, Matlab’s quadprog solver) are 1 sec for pure QPs (e.g., the trajectory in Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals had a flight time of 30 sec and was generated in 1.4 sec) and tens of sec for IQPs (e.g., the trajectory in Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals had a flight time of 20 sec and was generated in 14 sec). Optimizing over a receding horizon which is shifted along the trajectory may be a fruitful strategy to speed up the algorithm. Another idea would be to split a trajectory in overlapping and reasonable constrained sub-trajectories and optimize them separately. Both approaches would negate the global optimality property of generated trajectories, requiring evaluation of real-world feasibility.

Once we generate trajectory control inputs these can be transmitted to a real quadrotor. Our real-time control system builds on the PIXHAWK autopilot software [?]. Desired positions along the motion plan, camera look-at vectors and target trajectories are transmitted from a ground-station via the Robot Operating System (ROS). An LQR (Linear-quadratic regulator) running on a dedicated single-board computer computes the necessary forces and moments to track the motion plan. These forces are then translated into low-level rotor and gimbal speeds by further controllers running on a PX4 FMU. We created result figures using two different quadrotor platforms: the 3DR Solo and a custom-build Pixhawk-based platform.

Design Tool: The 3D trajectory design tool has been implemented as Unity 3D tool which allows for easy adaptation and integration of a variety of IO devices. A further advantage of this design decision is that it is easy to develop augmented reality applications such as mixing real and virtual quadrotors in a racing scenario. We have interfaced the design tool with our optimization algorithm implemented using the Matlab optimization toolbox. The source code for the optimization algorithm can be found in the supplementary materials as self-contained Matlab code.

Despite having used camera planning as running example we note that our method is general and can be applied in many different application scenarios. In particular, the discrete nature of the proposed IQP scheme makes it straightforward to incorporate application specific constraints. In this section we want to illustrate a number of interactive usage scenarios which we have implemented using our method.

Quadrotors have already been used in entertainment settings, in particular to create spectacular aerial light shows (cf. [?]). However, creating such complex and coordinated flight patterns is not possible with consumer grade technologies and hence has not been accessible to the end-user. Our tool allows for straightforward end-user design of such creative scenarios.

Figure \thefigure: (A) Handwritten input. (B) Initial feasible trajectory can be overly smooth. (C) After iteration a feasible and visually pleasing trajecory is found. (D) Final result flown by MAV and captured via long-exposure photography.

One such example is illustrated in Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals. Here the user provides input position constraints by writing or sketching the desired shape. Our method then generates a feasible trajectory which as a side-effect of minimizing snap also smooths the input strokes. However, the generated trajectory may not coincide with the desired output e.g. because it linearly interpolates the keyframes so that handwriting may not be legible anymore (see Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals, B). The user can correct for this by changing the parameters of the optimization scheme (e.g., weights of the energies) or by adjusting keyframe positions and timings.

Once satisfied the trajectory can be flown by a real robot. In Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals we have mounted a bright LED to the robot and captured the flight path via long-exposure photography.

Another interesting application domain is that of aerial racing. First person drone racing is an emerging sport that requires a lot of expertise in manual quadrotor control. Our tool can bring this within reach of the end-user. As a proof of concept we have developed a simple aerial racing game. In this scenario a user can design a free-form race course, specifying length, curvature and other parameters as well as overall race-time.

Figure \thefigure: Two player aerial racing. User input is weighted with automatic control to adjust difficulty.

For the race itself we implemented a semi-manual flight mode for which we changed the position controller, by remapping the feedforward term () of Eq. (14) to the joystick of a game controller. Thereby, the user can choose the direction and the strength of the feedforward-force allowing him to deviate with the quadrotor from the generated reference trajectory. Users can then, for instance, take a short cut in a curve or fly the trajectory with a higher velocity than generated by the optimization method. The score is calculated as a function of the deviation from the generated trajectory and the time needed to complete all laps. In other words, the player who managed to stay on the trajectory as fast as possible will win. We note that by manipulating the underlying controller, it would be possible to introduce further video game concepts such as player strength balancing into real-world quad racing. For example, allowing a player to temporarily race on a faster reference trajectory than his opponents.

Our main results stem from the application scenario of aerial videography. We have already mentioned the technical details and how we incorporate cinematographic goals into our optimization scheme. Here we briefly summarize a number of interesting and challenging video-shots (best viewed in video).

Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals illustrates a shot where a quadrotor flies over a toy castle and at the same time records it. Here the gimbal has to smoothly track the target just as the quadrotor swoops over the object and turns around its own axis once reaching the highest point. Such a shot composition is difficult to achieve manually due to the complicated quadrotor-camera-target coordination.

Figure \thefigure: Multi target shot. Top row: frames of the video sequence shot by the onboard camera. Bottom row: according quadrotor positions shown in the preview of the design tool.

Even with conventional cameras, composition of multi target shots is a very challenging task. Aerial-videography makes this even more difficult due to the many degrees of freedom and complex geometric dependencies requiring coordination for smooth, jerk-free transitions from one to the next target while airborne. In Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals we illustrate a sliding shot, transitioning between targets – the two actors – while the camera is moving from left to right and steadily rising in altitude. Throughout the entire trajectory the oerientations of quad and camera never remain constant, yet the camera targets are kept in focus and the transitions are smooth. Flying such a trajectory manually would only be possible with two operators, one for steering the camera, the other the quadrotor.

So far we presented a novel method to generate quadrotor trajectories subject to high-level goals and demonstrated its feasibility in different applications. In the remainder of this paper we are going to discuss the limitations of our approach and highlight interesting areas for future work.

The optimization framework proposed in this paper has proven to be powerful and versatile however there are of course a number of limitations. First, our goal is to enable non-expert users to design arbitrary MAV use cases. While the method is generic and designed to be extensible it does require expertise and effort to formalize further objectives (that we have not treated so far) and to integrate them into the algorithm. We believe that our high-level design tool bridges the gap between the underlying optimization algorithm and end-user goals sufficiently well. Nonetheless it is an interesting future research question how end-users could extend not only the use-cases we have demonstrated but also the optimization itself.

Currently all our application scenarios depend on a high precision indoor tracking system. This is a limiting factor as one would of course like to fly many of the examples outdoors using GPS sensing. To this end our method is generic and could be made to work with any localization system, in particular with GPS position data in outdoor scenarios. However, we have not implemented this and of course the localization accuracy would impact the exact results.

The optimization-based design of quadrotor trajectories subject to high-level user constraints is a comprehensive research space and our work only started to cover it. The investigations we did so far raised a number of additional research problems. In our method, the time at which a certain keyframe is reached cannot be changed by the optimization scheme. To extend our algorithm, it would be interesting to formalize the optimization problem in a way that both, the keyframe’s position and its time can be optimized.

Furthermore, the use case of aerial videography raised the question: what is an aesthetic aerial video sequence and is it possible to optimize for it? By incorporating human objectives into the optimization, our work already presents a starting point, nevertheless it would be interesting to see whether further concepts and rules of cinematography can be incorporated into the optimization problem.

Nonetheless, our method is generic and can be applied to further use cases. For example, it would be possible to extend the method to 3D scanning of buildings and other objects of interest. Here one could integrate objectives that capture e.g., reconstruction quality and surface coverage. Another possible example includes an advanced flying action camera for outdoor usage enabling users to trigger pre-defined trajectories on-the-fly. These scenarios would obviously require additional information such as the environment’s 3D geometry for collision avoidance and accurate localization of drone and human in the outdoor case. Finally, it is not only drones that our method applies to. Most straightforward would be an extension to other actuated camera platforms such as dollies and robotic arms.

In summary we have proposed a user in the loop design tool for the creation of aerial robotic behavior. At its core lies an optimization-based algorithm that integrates low-level quadrotor control constraints and high-level human objectives. Therefore, we used a linear approximation of the quadrotor model enabling us to generate trajectories subject to the physical limits of a quadrotor. Stating the problem as discrete, additionally permits the easy incorporation of high-level constraints to support the user, for instance, in the creation of pleasing aerial footage. This allows users to concentrate on the creative and aesthetic aspects of the task at hand and requires little to no expertise in quadrotor control or the target domain. We have demonstrated the flexibility and utility of our approach in three different use cases including aerial videography, light painting and racing.

We thank Cécile Edwards-Rietmann for providing the video voiceover and Gábor Sörös for creating the aerial light-painting videos. We are also grateful for the valuable feedback from the associate chairs and external reviewers. This work was partially funded by the Swiss Science Foundations (UFO 200021L_153644) and Microsoft Research.

  • 1
  • 2 Javier Alonso-Mora, Tobias Naegeli, Roland Siegwart, and Paul Beardsley. 2015. Collision avoidance for aerial vehicles in multi-agent scenarios. Autonomous Robots 39, 1 (2015), 101–121. DOI:http://dx.doi.org/10.1007/s10514-015-9429-0 
  • 3 ArsElectronica. 2012. Spaxels. (2012). http://www.aec.at/spaxels/.
  • 4 Cannes Festival. 2012. New Directors’ Showcase. Video. (2012). https://youtu.be/cseTX_rW3uM
  • 5 Marc Christie, Rumesh Machap, Jean-Marie Normand, Patrick Olivier, and Jonathan Pickering. 2005. Virtual camera planning: A survey. In Smart Graphics. Springer, 40–52.
  • 6 T.J. Diaz. 2015. Lights, drone… action. Spectrum, IEEE 52, 7 (July 2015), 36–41. DOI:http://dx.doi.org/10.1109/MSPEC.2015.7131693 
  • 7 Nadeem Faiz, Sunil K Agrawal, and Richard M Murray. 2001. Trajectory planning of differentially flat systems with dynamics and inequalities. Journal of Guidance, Control, and Dynamics 24, 2 (2001), 219–227.
  • 8 Tamar Flash and Neville Hogan. 1985. The coordination of arm movements: an experimentally confirmed mathematical model. The journal of Neuroscience 5, 7 (1985), 1688–1703.
  • 9 Michael L. Gleicher and Feng Liu. 2008. Re-cinematography: Improving the Camerawork of Casual Video. ACM Trans. Multimedia Comput. Commun. Appl. 5, 1, Article 2 (Oct. 2008), 28 pages. DOI:http://dx.doi.org/10.1145/1404880.1404882 
  • 10 M. Grundmann, V. Kwatra, and I. Essa. 2011. Auto-directed video stabilization with robust L1 optimal camera paths. In Computer Vision and Pattern Recognition (CVPR), 2011 IEEE Conference on. 225–232. DOI:http://dx.doi.org/10.1109/CVPR.2011.5995525 
  • 11 Keita Higuchi and Jun Rekimoto. 2012. Flying Head: Head-synchronized Unmanned Aerial Vehicle Control for Flying Telepresence. In SIGGRAPH Asia 2012 E-Tech (SA ’12). ACM, New York, NY, USA, 12:1—-12:2. DOI:http://dx.doi.org/10.1145/2407707.2407719 
  • 12 Keita Higuchi, Tetsuro Shimada, and Jun Rekimoto. 2011. Flying Sports Assistant: External Visual Imagery Representation for Sports Training. In Augmented Human International Conference (AH ’11). ACM, 7:1—-7:4. DOI:http://dx.doi.org/10.1145/1959826.1959833 
  • 13 Niels Joubert, Mike Roberts, Anh Truong, Floraine Berthouzoz, and Pat Hanrahan. 2015. An Interactive Tool for Designing Quadrotor Camera Shots. ACM Trans. Graph. 34, 6, Article 238 (Oct. 2015), Article 238, 11 pages. DOI:http://dx.doi.org/10.1145/2816795.2818106 
  • 14 Jun Kato, Daisuke Sakamoto, and Takeo Igarashi. 2012. Phybots: A Toolkit for Making Robotic Things. In Proceedings of the Designing Interactive Systems Conference (DIS ’12). ACM, New York, NY, USA, 248–257. DOI:http://dx.doi.org/10.1145/2317956.2317996 
  • 15 Johannes Kopf, Michael F. Cohen, and Richard Szeliski. 2014. First-person Hyper-lapse Videos. ACM Trans. Graph. 33, 4, Article 78 (July 2014), 10 pages. DOI:http://dx.doi.org/10.1145/2601097.2601195 
  • 16 Taeyoung Lee, Melvin Leok, and N Harris McClamroch. 2013. Nonlinear robust tracking control of a quadrotor UAV on SE (3). Asian Journal of Control 15, 2 (2013), 391–408.
  • 17 Tsai-Yen Li and Chung-Chiang Cheng. 2008. Real-Time Camera Planning for Navigation in Virtual Environments. In Smart Graphics, Andreas Butz, Brian Fisher, Antonio Krüger, Patrick Olivier, and Marc Christie (Eds.). Lecture Notes in Computer Science, Vol. 5166. Springer Berlin Heidelberg, 118–129. DOI:http://dx.doi.org/10.1007/978-3-540-85412-8_11 
  • 18 Kexi Liu, Daisuke Sakamoto, Masahiko Inami, and Takeo Igarashi. 2011. Roboshop: Multi-layered Sketching Interface for Robot Housework Assignment and Management. In Proceedings of the SIGCHI Conference on Human Factors in Computing Systems (CHI ’11). ACM, New York, NY, USA, 647–656. DOI:http://dx.doi.org/10.1145/1978942.1979035 
  • 19 Shuaicheng Liu, Lu Yuan, Ping Tan, and Jian Sun. 2013. Bundled Camera Paths for Video Stabilization. ACM Trans. Graph. 32, 4, Article 78 (July 2013), 10 pages. DOI:http://dx.doi.org/10.1145/2461912.2461995 
  • 20 Sergei Lupashin and Raffaello D’Andrea. 2012. Adaptive fast open-loop maneuvers for quadrocopters. Autonomous Robots 33, 1-2 (April 2012), 89–102. http://link.springer.com/10.1007/s10514-012-9289-9
  • 21 Robert Mahony, Vijay Kumar, and Peter Corke. 2012. Multirotor Aerial Vehicles: Modeling, Estimation, and Control of Quadrotor. IEEE Robotics & Automation Magazine 19, 3 (Sept. 2012), 20–32. http://ieeexplore.ieee.org/lpdocs/epic03/wrapper.htm?arnumber=6289431
  • 22 Tobias Martin, Nobuyuki Umetani, and Bernd Bickel. 2015. OmniAD: Data-driven Omni-directional Aerodynamics. ACM Trans. Graph. 34, 4, Article 113 (July 2015), 12 pages. DOI:http://dx.doi.org/10.1145/2766919 
  • 23 Joseph V Mascelli. 1998. The five C’s of cinematography: motion picture filming techniques. Silman-James Press.
  • 24 Lorenz Meier, Petri Tanskanen, Lionel Heng, Gim Hee Lee, Friedrich Fraundorfer, and Marc Pollefeys. 2012. PIXHAWK: A micro aerial vehicle design for autonomous flight using onboard computer vision. Autonomous Robots 33, 1-2 (Feb. 2012), 21–39. http://link.springer.com/10.1007/s10514-012-9281-4
  • 25 Daniel Mellinger and Vijay Kumar. 2011. Minimum snap trajectory generation and control for quadrotors. In Robotics and Automation (ICRA), 2011 IEEE International Conference on. IEEE, 2520–2525.
  • 26 Florian ’Floyd’ Mueller and Matthew Muirhead. 2015. Jogging with a Quadcopter. In Proceedings of the 33rd Annual ACM Conference on Human Factors in Computing Systems (CHI ’15). ACM, New York, NY, USA, 2023–2032. DOI:http://dx.doi.org/10.1145/2702123.2702472 
  • 27 Tobias Nägeli, Christian Conte, Alexander Domahidi, Manfred Morari, and Otmar Hilliges. 2014. Environment-independent formation flight for micro aerial vehicles. In Intelligent Robots and Systems (IROS 2014), 2014 IEEE/RSJ International Conference on. 1141–1146. DOI:http://dx.doi.org/10.1109/IROS.2014.6942701 
  • 28 Tayyab Naseer, J Sturm, and D Cremers. 2013. Followme: Person following and gesture recognition with a quadrocopter. Proc. IROS (2013). https://vision.in.tum.de/_media/spezial/bib/naseer2013iros.pdf
  • 29 Kei Nitta, Keita Higuchi, and Jun Rekimoto. 2014. HoverBall: Augmented Sports with a Flying Ball. In Augmented Human International Conference (AH ’14) (AH ’14). ACM, New York, NY, USA, 13:1—-13:4. DOI:http://dx.doi.org/10.1145/2582051.2582064 
  • 30 Daisuke Sakamoto, Koichiro Honda, Masahiko Inami, and Takeo Igarashi. 2009. Sketch and run. In ACM SIGCHI. ACM Press, New York, New York, USA, 197. http://dl.acm.org/citation.cfm?id=1518701.1518733
  • 31 Jürgen Scheible, Achim Hoth, Julian Saal, and Haifeng Su. 2013. Displaydrone: a flying robot based interactive display. In ACM International Symposium on Pervasive Displays (PerDis ’13). ACM Press, New York, New York, USA, 49. http://dl.acm.org/citation.cfm?id=2491568.2491580
  • 32 Yuta Sugiura, Diasuke Sakamoto, Anusha Withana, Masahiko Inami, and Takeo Igarashi. 2010. Cooking with robots. In ACM SIGCHI. ACM Press, New York, New York, USA, 2427. http://dl.acm.org/citation.cfm?id=1753326.1753693
  • 33 Nobuyuki Umetani, Yuki Koyama, Ryan Schmidt, and Takeo Igarashi. 2014. Pteromys: Interactive Design and Optimization of Free-formed Free-flight Model Airplanes. ACM Trans. Graph. 33, 4, Article 65 (July 2014), 10 pages. DOI:http://dx.doi.org/10.1145/2601097.2601129 
  • 34 I-Cheng Yeh, Chao-Hung Lin, Hung-Jen Chien, and Tong-Yee Lee. 2011. Efficient camera path planning algorithm for human motion overview. Computer Animation and Virtual Worlds 22, 2-3 (2011), 239–250. DOI:http://dx.doi.org/10.1002/cav.398 
  • 35 Shigeo Yoshida, Takumi Shirokura, Yuta Sugiura, Daisuke Sakamoto, Tetsuo Ono, Masahiko Inami, and Takeo Igarashi. 2015. RoboJockey: Designing an Entertainment Experience with Robots. IEEE computer graphics and applications 1 (Jan. 2015), 1. http://www.computer.org/csdl/mags/cg/preprint/07005367-abs.html
  • 36 Shengdong Zhao, Koichi Nakamura, Kentaro Ishii, and Takeo Igarashi. 2009. Magic Cards: A Paper Tag Interface for Implicit Robot Control. In Proceedings of the SIGCHI Conference on Human Factors in Computing Systems (CHI ’09). ACM, New York, NY, USA, 173–182. DOI:http://dx.doi.org/10.1145/1518701.1518730 

In the work proposed here we use an approximation of a full, non-linear quadcopter model for the optimization-based generation of trajectories. However, the resulting trajectories need to be flown by a real quadcopter and hence one must relate the approximate model to the full model of the quadcopter. Here we briefly summarize the modeling and control aspects necessary for replication of our method. A full introduction to this topic is beyond the scope of this work and we refer the interested reader to [?].

A quadrotor is a robot with four identical rotors which generate a thrust and a moment orthogonal to the square they span. Our quadrotor model closely follows [?]. To describe the configuration of a quadrotor we define its position as the location of the center of mass in an inertial world coordinate frame (, , ), and its attitude as the rotation of the body-fixed frame (, , ) with respect to the world frame (see Fig. Airways: Optimization-Based Planning of Quadrotor Trajectories according to High-Level User Goals). The rotation matrix from body to world frame is then given by . Each rotor of the drone has an angular speed and produces a force and moment , according to

where and are constants specific to the rotors. Therefore, the control input to the quadrotor can be written as where is the net force in direction and , , are the moments in , , direction acting on the quadrotor. The input can be expressed in terms of the rotor speeds , , , :

(11)

where L is the distance from the axis of rotation of the rotors to the center of mass of the quadrotor.

The position of the quadrotor in the world frame can be specified according to Newton’s equation of motion governing the acceleration of a mass point:

(12)

where is the position vector, is the gravity vector pointing along the axis of the world frame, is the gravitational constant and is the mass of the quadrotor.

Figure \thefigure: A quadrotor in 3D with its flat outputs (position , yaw angle ), world (, , ) and body frame (, , ), the rotational velocities of the quadrotor in each dimension (, , ), the distance from the axis of rotation of a rotor to the center of mass of the quadrotor, as well as the thrust forces and angular velocities of each rotor.

The Euler rotation equations are

(13)

where is the moment vector acting on the quadrotor in the body frame, is the angular velocity of the body frame in the world frame and is the moment of inertia of the quadrotor in the body frame.

As can be seen from the equations Eq. (11), Eq. (12) and Eq. (13), the quadrotor configuration has degrees of freedom but only actuators. Therefore it is an underactuated system and cannot follow arbitrary trajectories in the configuration space. However, Mellinger et al. show that the system is flat [?] with respect to the flat outputs and thus a quadrotor can follow trajectories in this space, given that the corresponding inputs are bounded to values that the quadrotor can achieve [?]. This flat output space is the configuration of our approximate quadrotor model.

We use the linear controller from [?] to generate the corresponding inputs for the quadrotor. The desired thrust along the -axis of the body frame is computed as

(14)

where is the actual and the desired position and velocity of the quadrotor and the feedforward term which compensates for gravity and known accelerations. The state feedback matrix is computed using a linear quadratic control strategy with integral action.

The desired force already defines two degrees of freedom of the quadrotor attitude. Using the nonlinear control strategy on described in [?] we employ the desired yaw angle to compute the desired attitude of the quadrotor:

where are the desired - and -axis of the body frame. To control the attitude we can now calculate the desired moment vector in direction,

where is the actual rotation of the quadrotor, is the rotation error, , are the angular and desired angular velocity, is the angular velocity error and is the vee map from . From and we can calculate the input and thereby the velocities of the rotors needed to reach the desired position and yaw angle:

(15)

where Eq. (15) is the projection of the desired thrust on the actual z-vector of the body frame . Finally, using Eq. (11) we can compute the angular velocities corresponding to the input .

Following the approach in [?], we assume that the rotational dynamics of a quadrotor are fast compared to its translational dynamics thus we can describe the behavior of the quadrotor by the thrust vector and the moment along the body-frame z-axis. In the following we will only refer to the norm of the force vector

Let be the maximum force and be the maximum moment each motor can produce. Then the bound on the maximum possible thrust that the quadrotor can achieve (i.e. all motors full on) is

and the bound on the maximum possible moment (i.e. two motors rotating in same direction full on and the other two off) is

Because the force and moment are coupled it is not possible to achieve full thrust and full moment at the same time.

Let us now assume a stricter bound on the maximum moment of the quadrotor:

where . If we want to be able to achieve a moment of at all times we have to take into account that in the extreme case two motors will be limited to a force of and thus the bound on the thrust of the quadrotor is

For example, if , i.e. bounding the moment to of the quadrotors maximum moment the quadrotor can still achieve of its maximum thrust at all times. These limits still allow the agility of a quadrotor to be sufficient for many use cases.

Comments 0
Request Comment
You are adding the first comment!
How to quickly get a good reply:
  • Give credit where it’s due by listing out the positive aspects of a paper before getting into which changes should be made.
  • Be specific in your critique, and provide supporting evidence with appropriate references to substantiate general statements.
  • Your comment should inspire ideas to flow and help the author improves the paper.

The better we are at sharing our knowledge with each other, the faster we move forward.
""
The feedback must be of minimum 40 characters and the title a minimum of 5 characters
   
Add comment
Cancel
Loading ...
379663
This is a comment super asjknd jkasnjk adsnkj
Upvote
Downvote
""
The feedback must be of minumum 40 characters
The feedback must be of minumum 40 characters
Submit
Cancel

You are asking your first question!
How to quickly get a good answer:
  • Keep your question short and to the point
  • Check for grammar or spelling errors.
  • Phrase it like a question
Test
Test description