我正在使用融合了Madwick算法的python模块的传感器。源代码可以在https://github.com/micropython-IMU/micropython-fusion/blob/master/fusion.py.
找到有没有办法在不使用import pyb的情况下实现 pyb.elapsed_micro() 和 pyb.micros()下的功能库用python2.7?
import pyb
# Integrate to yield quaternion
deltat = pyb.elapsed_micros(self.start_time) / 1000000
self.start_time = pyb.micros()
q1 += qDot1 * deltat
q2 += qDot2 * deltat
q3 += qDot3 * deltat
q4 += qDot4 * deltat
# normalise quaternion
norm = 1 / sqrt(q1 * q1 + q2 * q2 + q3 * q3 + q4 * q4)
self.q = q1 * norm, q2 * norm, q3 * norm, q4 * norm
答案 0 :(得分:0)
pyb.micros() - 以微秒开始设置
pyb.elapsed_time(start_time) - 确定startime和调用此函数所用时间之间的经过时间
import time
def micros():
return time.time() * 1000000 ##turns seconds into microseconds
def elapsed_micros(start_time):
return start_time - time.time()*1000000
要获得更多支持,请检查github链接以发布 - https://github.com/micropython-IMU/micropython-fusion/issues/1