本文整理汇总了Python中quaternion.Quaternion.identity方法的典型用法代码示例。如果您正苦于以下问题：Python Quaternion.identity方法的具体用法？Python Quaternion.identity怎么用？Python Quaternion.identity使用的例子？那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类quaternion.Quaternion的用法示例。
在下文中一共展示了Quaternion.identity方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: Adafruit_L3GD20
# 需要导入模块: from quaternion import Quaternion [as 别名]
# 或者: from quaternion.Quaternion import identity [as 别名]
import zmq
import json
from quaternion import Quaternion, dqdT
from numpy import array
from math import pi
gyr = Adafruit_L3GD20()
ctx = zmq.Context()
pub = ctx.socket(zmq.PUB)
port = 5559
pub.bind("tcp://*:%s" % port)
state = {}
state["q"] = Quaternion.identity()
state["gyrobias"] = array([-1.7700930656934308, -5.679372718978101, -0.9736322992700736])
cbias = 0.005
ts = 0.05
def task20Hz():
w = array(gyr.read())
q = state["q"]
gyrobias = state["gyrobias"]
q = dqdT(q, (w - gyrobias) * pi / 180, ts)
q.normalize()
gyrobias = cbias * w + (1 - cbias) * gyrobias
state["q"] = q