如何在加速度计中有一个好的频率?

如何解决如何在加速度计中有一个好的频率?

所以我在互联网上找到了这个代码来使用 3 轴加速度计和 3 轴陀螺仪,并使用 i2c 通信获取其值。在另一个文件中,我用它来打印 csv 文件中的数据,但它打印了很多值,比如在 5 秒内打印了 149k 行,但是按照数据表,我想我只得到了 6667 Hz 的加速度值行accel_config_sel = [0b10100000]。该字节的前 4 位是频率数据,您可以在第 49 页的 https://download.mikroe.com/documents/datasheets/asm330lhh_datasheet.pdf 处看到它。 加速度计代码如下:

import time,smbus2,smbus

def ASM330_start():
 
    #Write to Gyro configuration register
    gyro_config_sel = [0b00010000] # byte registers @12.5Hz
    gyro_config_vals = [250.0] # degrees/sec
    gyro_indx = 0
    bus.write_byte_data(ASM330_ADDR,CTRL2_G,int(gyro_config_sel[gyro_indx]))
    time.sleep(0.1)
    #Write to Accel configuration register
    accel_config_sel = [0b10100000] # byte registers @6667Hz
    accel_config_vals = [2.0] # g (g = 9.81 m/s^2)
    accel_indx = 0
    bus.write_byte_data(ASM330_ADDR,CTRL1_XL,int(accel_config_sel[accel_indx]))
    time.sleep(0.1)
    # interrupt register (related to overflow of data [FIFO])
    bus.write_byte_data(ASM330_ADDR,INT_CFG1,1)
    time.sleep(0.1)
    return gyro_config_vals[gyro_indx],accel_config_vals[accel_indx]

def read_raw_bits(register):
    # read accel and gyro values
    high = bus.read_byte_data(ASM330_ADDR,register)
    low = bus.read_byte_data(ASM330_ADDR,register+1)

    # combine higha and low for unsigned bit value
    value = ((high << 8) | low)

    # convert to +- value
    if(value > 32768):
        value -= 65536
    return value

def ASM330_conv():
    # raw acceleration bits
    acc_x = read_raw_bits(OUTX_H_A)
    acc_y = read_raw_bits(OUTY_H_A)
    acc_z = read_raw_bits(OUTZ_H_A)

    # raw gyroscope bits
    gyro_x = read_raw_bits(OUTX_H_G)
    gyro_y = read_raw_bits(OUTY_H_G)
    gyro_z = read_raw_bits(OUTZ_H_G)

    #convert to acceleration in g and gyro dps
    a_x = (acc_x/(2.0**15.0))*accel_sens
    a_y = (acc_y/(2.0**15.0))*accel_sens
    a_z = (acc_z/(2.0**15.0))*accel_sens

    w_x = (gyro_x/(2.0**15.0))*gyro_sens
    w_y = (gyro_y/(2.0**15.0))*gyro_sens
    w_z = (gyro_z/(2.0**15.0))*gyro_sens

    return a_x,a_y,a_z,w_x,w_y,w_z


# ASM330 Registers

ASM330_ADDR = 0x6A
CTRL2_G  = 0x11
CTRL1_XL = 0x10
INT_CFG1   = 0x58
OUTX_H_A = 0x29
OUTY_H_A = 0x2B
OUTZ_H_A = 0x2D
OUTX_H_G  = 0x23
OUTY_H_G  = 0x25
OUTZ_H_G  = 0x27

# start I2C driver
bus = smbus2.SMBus(0) # start comm with i2c bus
gyro_sens,accel_sens = ASM330_start() # instantiate gyro/accel

这里是获取 2 个独立 csv 文件数据的代码:

from final import *
from dist import *
from gps import *
import Jetson.GPIO as GPIO
import csv
import threading

GPIO.setmode(GPIO.BOARD)
GPIO.setwarnings(False)
###########VARIABLES###############
led_pin = 7
botao_pin = 15
luz = False
contador = 0
GPIO.setup(botao_pin,GPIO.IN)
GPIO.setup(led_pin,GPIO.OUT)

gpsd = gps(mode=WATCH_ENABLE) #starting the stream of info

ax = 0
ay = 0
az = 0
wx = 0
wy = 0
wz = 0
data = 0
lat = 0
lon = 0
alt = 0
vel = 0
errolat = 0
errolon = 0
erroalt = 0
tempo = 0
##############FUNCTIONS############
def leracc():
    while 1:
        global ax,ay,az,wx,wy,wz
        ax,wz = ASM330_conv()

def lerSD():
    while 1:
        global data
        data = SD_start()

def lerGPS():
    while 1:
        global lat,lon,alt,vel,errolat,errolon,erroalt,tempo
        gpsd.next()
        lat = gpsd.fix.latitude
        lon = gpsd.fix.longitude
        alt = gpsd.fix.altitude
        vel = gpsd.fix.speed
        errolat = gpsd.fix.epy
        errolon = gpsd.fix.epx
        erroalt = gpsd.fix.epv
        tempo = gpsd.utc

def botao():
    antes = True
    while 1:
        global luz
        estado = GPIO.input(botao_pin)
        if (antes==True and estado==False):
            luz = not(luz)
        GPIO.output(led_pin,luz)
        antes = estado
#########################THREADS#####################
t1 = threading.Thread(target=leracc)
t2 = threading.Thread(target=lerSD)
t3 = threading.Thread(target=lerGPS)
t4 = threading.Thread(target=botao)

t1.start()
t2.start()
t3.start()
t4.start()
##############HEADERS FROM CSV################
header = ["gX","gY","gZ","Centimetros","Latitude","Longitude","Altitude","Velocidade","ErroLat","ErroLon","ErroAlt","Horas"]
headeracc = ["AccelX","AccelY","AccelZ"]
##################MAIN PROGRAM#################
while 1:
    if(luz==True):
        with open ('/home/built/Desktop/Projetos/final/dados.csv','a') as csvFileData:
            with open ('/home/built/Desktop/Projetos/final/acc.csv','a') as csvFileacc:
                    writeracc = csv.writer(csvFileacc)
                    writerData = csv.writer(csvFileData)
                    while (contador < 1):
                        writeracc.writerow(headeracc)
                        writerData.writerow(header)
                        contador = contador + 1
                    while(luz==True):
                        dados = [wx,wz,data,lat,tempo]
                        dataacc = [ax,tempo]
                        writeracc.writerow(dataacc)
                        writerData.writerow(dados)
                    csvFileacc.close()
                    csvFileData.close()

csv 文件只有大量数据,甚至除了传感器的最大频率。任何人都知道这怎么可能,我如何才能在加速度计 csv 文件中以 6667Hz 打印,在陀螺仪加 GPS csv 文件中以 12.5Hz 打印?感谢您的帮助!

版权声明:本文内容由互联网用户自发贡献,该文观点与技术仅代表作者本人。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如发现本站有涉嫌侵权/违法违规的内容, 请发送邮件至 dio@foxmail.com 举报,一经查实,本站将立刻删除。

相关推荐


使用本地python环境可以成功执行 import pandas as pd import matplotlib.pyplot as plt # 设置字体 plt.rcParams[&#39;font.sans-serif&#39;] = [&#39;SimHei&#39;] # 能正确显示负号 p
错误1:Request method ‘DELETE‘ not supported 错误还原:controller层有一个接口,访问该接口时报错:Request method ‘DELETE‘ not supported 错误原因:没有接收到前端传入的参数,修改为如下 参考 错误2:cannot r
错误1:启动docker镜像时报错:Error response from daemon: driver failed programming external connectivity on endpoint quirky_allen 解决方法:重启docker -&gt; systemctl r
错误1:private field ‘xxx‘ is never assigned 按Altʾnter快捷键,选择第2项 参考:https://blog.csdn.net/shi_hong_fei_hei/article/details/88814070 错误2:启动时报错,不能找到主启动类 #
报错如下,通过源不能下载,最后警告pip需升级版本 Requirement already satisfied: pip in c:\users\ychen\appdata\local\programs\python\python310\lib\site-packages (22.0.4) Coll
错误1:maven打包报错 错误还原:使用maven打包项目时报错如下 [ERROR] Failed to execute goal org.apache.maven.plugins:maven-resources-plugin:3.2.0:resources (default-resources)
错误1:服务调用时报错 服务消费者模块assess通过openFeign调用服务提供者模块hires 如下为服务提供者模块hires的控制层接口 @RestController @RequestMapping(&quot;/hires&quot;) public class FeignControl
错误1:运行项目后报如下错误 解决方案 报错2:Failed to execute goal org.apache.maven.plugins:maven-compiler-plugin:3.8.1:compile (default-compile) on project sb 解决方案:在pom.
参考 错误原因 过滤器或拦截器在生效时,redisTemplate还没有注入 解决方案:在注入容器时就生效 @Component //项目运行时就注入Spring容器 public class RedisBean { @Resource private RedisTemplate&lt;String
使用vite构建项目报错 C:\Users\ychen\work&gt;npm init @vitejs/app @vitejs/create-app is deprecated, use npm init vite instead C:\Users\ychen\AppData\Local\npm-
参考1 参考2 解决方案 # 点击安装源 协议选择 http:// 路径填写 mirrors.aliyun.com/centos/8.3.2011/BaseOS/x86_64/os URL类型 软件库URL 其他路径 # 版本 7 mirrors.aliyun.com/centos/7/os/x86
报错1 [root@slave1 data_mocker]# kafka-console-consumer.sh --bootstrap-server slave1:9092 --topic topic_db [2023-12-19 18:31:12,770] WARN [Consumer clie
错误1 # 重写数据 hive (edu)&gt; insert overwrite table dwd_trade_cart_add_inc &gt; select data.id, &gt; data.user_id, &gt; data.course_id, &gt; date_format(
错误1 hive (edu)&gt; insert into huanhuan values(1,&#39;haoge&#39;); Query ID = root_20240110071417_fe1517ad-3607-41f4-bdcf-d00b98ac443e Total jobs = 1
报错1:执行到如下就不执行了,没有显示Successfully registered new MBean. [root@slave1 bin]# /usr/local/software/flume-1.9.0/bin/flume-ng agent -n a1 -c /usr/local/softwa
虚拟及没有启动任何服务器查看jps会显示jps,如果没有显示任何东西 [root@slave2 ~]# jps 9647 Jps 解决方案 # 进入/tmp查看 [root@slave1 dfs]# cd /tmp [root@slave1 tmp]# ll 总用量 48 drwxr-xr-x. 2
报错1 hive&gt; show databases; OK Failed with exception java.io.IOException:java.lang.RuntimeException: Error in configuring object Time taken: 0.474 se
报错1 [root@localhost ~]# vim -bash: vim: 未找到命令 安装vim yum -y install vim* # 查看是否安装成功 [root@hadoop01 hadoop]# rpm -qa |grep vim vim-X11-7.4.629-8.el7_9.x
修改hadoop配置 vi /usr/local/software/hadoop-2.9.2/etc/hadoop/yarn-site.xml # 添加如下 &lt;configuration&gt; &lt;property&gt; &lt;name&gt;yarn.nodemanager.res