mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-15 00:31:35 +08:00
56 lines
2.1 KiB
Python
56 lines
2.1 KiB
Python
#!/usr/bin/env python
|
|
# -*- coding: utf-8 -*-
|
|
"""
|
|
Copyright (c) 2022 PX4 Development Team
|
|
Redistribution and use in source and binary forms, with or without
|
|
modification, are permitted provided that the following conditions
|
|
are met:
|
|
|
|
1. Redistributions of source code must retain the above copyright
|
|
notice, this list of conditions and the following disclaimer.
|
|
2. Redistributions in binary form must reproduce the above copyright
|
|
notice, this list of conditions and the following disclaimer in
|
|
the documentation and/or other materials provided with the
|
|
distribution.
|
|
3. Neither the name PX4 nor the names of its contributors may be
|
|
used to endorse or promote products derived from this software
|
|
without specific prior written permission.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
"AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
|
FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
|
COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
|
BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
|
OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
|
AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
|
ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
File: frag_fusion_symbolic.py
|
|
Author: Mathieu Bresciani <mathieu@auterion.com>
|
|
License: BSD 3-Clause
|
|
Description:
|
|
"""
|
|
|
|
from sympy import *
|
|
|
|
V = Symbol("V", real=True)
|
|
rho = Symbol("rho", real=True)
|
|
rho_n = Symbol("rho_n", real=True)
|
|
Mcoef = Symbol("Mcoef", real=True)
|
|
Bcoef = Symbol("Bcoef", real=True)
|
|
a = Symbol("a", real=True)
|
|
|
|
f1 = 0.5 * rho / Bcoef * V**2 + rho_n * Mcoef * V - a
|
|
|
|
print("If Bcoef > 0 and Mcoef > 0")
|
|
print("V =")
|
|
res_V = solve(f1, V)
|
|
res_V = res_V[0]
|
|
pprint(res_V)
|
|
print("a_pred =")
|
|
pprint(solve(f1, a))
|