| 加工定制:否 | 品牌:PNI | 型号:RM3100 |
| 种类:多圈 | 材料:玻璃釉膜 | 性能:功率 |
| 货号:RM3100 | 用途:精密 | 阻值调节方式:旋转式 |
| 阻值变化方式:Z式(对数式) | 标称阻值:RM3100 | 额定功率:0.25W |
| 阻值允许偏差:±10% | 滑动噪声:RM3100V | 分辨率:RM3100% |
| 零位电阻:RM3100Ω | 接触电阻:RM3100Ω | 绝缘电阻:RM3100MΩ |
| 符合度:RM3100 | 是否跨境货源:否 |
基于多段地磁传感器的高速公路收费站车辆排队长度检测算法
【摘要】 针对交通管理部门对车辆排队长度智能化管控的迫切要求,本文提出了一种基于多段地磁传感器的高速公路收费站排队长度检测算法。通过研究驾驶员的行为习惯及车辆跟驰行驶中特点,本文对车辆跟驰行驶区与自由行驶区、跟驰行驶区与逼近前车区的速度临界值进行了界定,分析了车辆通过地磁传感器时速度的动态变化规律,并基于地磁传感器关键数据的相关性分析,提出了均速模型。最后利用现场试验对本检测算法进行验证,试验结果证明本文提出的均速模型能够***估计高速公路收费站前车辆排队长度,且地磁装置成本低廉、布设方便,能够大规模的推广应用,为交通管理部门实时监控交通运行情况提供帮助。
【关键词】 地磁传感器 高速公路收费站 排队长度检测 跟驰行驶 均速模型
引言:
随着经济不断发展,我国大中城市机动车保有辆也在不断攀升,截止到2015年底,深圳市机动车保有量超过320万辆[1],车辆密度达到481辆/公里,远超270辆/公里的国际警戒线,日益增多的机动车使得城市交通压力与日俱增。研究车辆排队长度,可以有效反映城市交通运行情况,辅助交通管理部门分析决策,从而缓解城市交通拥堵以及由此带来的交通安全等问题。目前我国车辆排队长度检测方法大体可以分为三类:
通过设置磁感线圈、微波探测器、雷达等传统交通监测设备进行排队长度检测及计算。
通过GPS数据对车辆排队长度进行检测。
通过视频数据对车辆排队长度进行检测。视频检测成本低、覆盖范围广、受环境影响小,准确度也相对较高,其理论误差可以控制在8%以内[1]。
相对于以上三类车辆排队长度检测方式,地磁传感器安装尺寸小、灵敏度高、使用寿命长、对路面破坏小,且其探测机制主要利用地球磁场在铁磁物体通过时的变化进行检测,对环境要求较低,能够准确的识别车辆存在和通过车型。目前我国基于地磁传感器的车辆排队长度算法研究相对较少,其中张永终等人融合地磁检测方法设计了一种多传感器融合检测系统,实现了对各方向排队长度的检测[2];贾利民等人根据单个地磁传感器数据反馈的车辆经过时长、车头车尾时距等动态变化规律,提出了车尾时距模型、通过时间模型和综合模型,为排队长度检测提供了一个新的算法[3]。本文基于地磁传感器在高速公路收费口的实际应用,利用多车道车辆通过距离收费站200m,125m,50m地磁传感器时的波形、时长等关键信息,提出了一种的新的车辆排队长度算法。为交通管理部门及高速公路企业提供了数据支撑和决策参考。
一、多段地磁传感器排队长度检测方法
1.1 问题分析
高速公路收费站前的车辆排队行为符合车辆跟驰特点,同时由于高速公路收费站口对车辆排队长度的硬性要求以及高速公路交通流的自身特点,其车辆排队行为又具有一定的特殊性。本文以车辆跟驰行为为基础,对高速公路收费站前车辆排队情况进行类比描述。
假定所有驾驶员行为符合MISSION模型,车辆在进入收费站排队过程中分别经过无反应区(可自由行驶段),无意识反应区(跟驰行驶区)以及有意识反应区(逼近前车区),车辆跟驰行驶情况如图1。
根据Hodfs的调查,驾驶员在高速行车中会低估安全距离,在实际交通中,距离与速度不成正比[4]。故假定车辆在无反应区行驶时匀速行驶;进入无意识反应区后将根据前车减速情况开始减速,视作匀减速阶段;进入有意识反应区时,车速随着车头间距减小而减小,视作变减速阶段。通过在收费站前有间隔的设置地磁传感器,可以***获得车辆通过地磁传感器时的波形、时长等各项数据变化情况,从而判断不同阶段车辆的实际行驶行为,最后估算出收费站前车辆的排队长度。
1.2 参数选取
受制于地磁特点和传感器埋设方式等条件影响,当出现车辆经过地磁传感器所在断面变换车道、车辆以非正常行车方式在道路上行驶(如两条道路之间行驶)以及地磁断面1至地磁断面4之间出入口不(如存在岔路)等情况时,会导致地磁传感器漏检、多检以及传输数据出现噪声数据,无法***反映车辆通过情况。
故在前期实验中本文抽取了7天地磁数据样本,并对样本中各项数据与排队长度的相关性以及样本数据本身的容错性进行了估算,其中:
为了确定样本的有效性,在前期实验中,以基于微波检测的深圳市非节假日、高速公路同一路段的不同时间车辆行驶数据的均值作为标准,对抽取的数据样本进行独立μ检验,设***水平ɑ = 5%。
各项特征数据与排队长度的相关性采用Spearman秩相关检验,即:将数据样本X与对应的排队长度样本Y配对形成(x1,y1),(x2,y2) (xn,yn),并将它排序,根据两个顺序样本的秩(Ri和Si)得到n对秩:(R1,S1)(R2,S2) (Rn,Sn)。有相关系数:
1.3 测距与阈值选取
根据MISSION模型,车辆在进入跟驰行驶区之前和逼近前车区时存在两个DV值(速度阈值),即SDV(驾驶员意识到正在靠近一辆低俗行驶车辆的临界点)与CLDV(跟驰过程中驾驶员意识到速度差很小但仍然靠近前车的临界点)。
为了准确的得到车辆在自由行使区、跟驰行驶区以及逼近前车区的相关数据,实验将地磁断面埋设间隔设置为50m,125m,200m。当车辆进入收费站200m检测范围内时,驾驶员将根据收费站前车辆排队情况进行减速,其中地磁断面车速判断阈值与两个临界值SDV与CLDV动态相关。
根据驾驶行为的不同程度,在有预期的平缓减速状态下,减速度的通常上限值在-2到-2.6M/S2之间。同时,受到驾驶员与车辆特性的共同制约,驾驶员从施加操纵力到出现操纵力的时间约为0.04s,驾驶员的反应时间参照表2。
表2 驾驶员反应时间及小客车制动系协调时间
可以估算出车辆进入逼近前车区时的临界速度CLDV约为4.16m/s,故3道地磁存在一个共同的拥堵阈值fb,逼近前车区内车辆速度不高于fb,即15km/h。
同理,3道地磁受到测距(埋设点至上一埋设点的距离)远近影响,对应存在2个的畅通阈值fub,即车辆进入跟驰行驶区的临界速度SDV。根据现场微波实测,车辆在进入收费站200m检测区域时均处于减速状态,平均减速度约为0.68m/ s2,根据公式:
二、实例分析
2.1 实验数据
实验选取2015年8月2日0时至24时全天的视频检测数据数据进行参照。地磁检测系统每5分钟提取一次断面的平均车速(平均车速=每5min内通过车辆速度总和/通过车辆数 ),剔除掉高于120km/h的异常数据后,可得以时间为X轴,各地磁断面平均车速为Y轴统计图(图中D2、D3、D4速度分别为断面2、3、4的平均时速,横坐标288个刻度为5分钟间隔序号)。
根据均速模型算法,地磁检测的排队长度与视频实时排队长度对比如图4(虚线为地磁检测数据,实线为视频检测数据)。根据Spearman秩相关检验法,得地磁检测排队长度与视频检测排队长度相关度达92.3%,实验结果达到预期值。
2.2 结果分析
由上述实验结果可以得出,本文提出的均速模型与现场视频检测结果高度吻合,综合实验中出现的异常情况,该均速模型受到的客观干扰主要存在以下两个方面:(1)收费站前不同车道车型不统一,需要结合车型识别对车辆经过断面产生的相对车速进行改良,减少测速扰动;(2)受到驾驶员行为影响,车辆会自动变道寻找排队长度***车道。
在收费站前排队长度较短情况下,车辆经过外围两道地磁断面时有可能出现变道情况,带来测速异常高值,需要进一步在均速计算中剔除明显异常高值。由于受到算法影响,在断面2、3存在异常高值情况时一般在距离收费站口较近的断面1不存在车辆变道情况(已经选好车道),故对系统判断车辆真实排队长度不产生影响,鲁棒性强。
另外,本文提到的收费站口排队长度检测系统可以进一步推广到城市交叉口信号检测中,结合平均车速直接辨别有利于直接判别拥堵情况,无需复杂的算法和数据处理,对处理器运行能力要求较低,便于推广。
三、结束语
结合跟驰模型中车辆行进行为以及MISSION模型对驾驶员行为的研究,得到了基于地磁传感器判别车辆行进情况的拥堵、畅通阈值,形成了对车辆排队长度有效估计的均速模型。
通过现场试验,证明了该模型的有效性。与传统视频检测、浮动车检测、微波检测方法相比,本文提出的排队长度算法更为简单,易于实现。另外地磁传感器成本低廉,安装方便,有利于快速推广。
/**************************************************************************************************
* Filename: sensor.c
* Revised: $Date: 2015-09-21 15:30:38 +0200 (fr, 21 sep 2015) $
* Revision: $Revision: 31581 $
*
* Description: Sensor driver shared code.
*
* Copyright (C) 2015 Texas Instruments Incorporated - /
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
*
* 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.
*
* Neither the name of Texas Instruments Incorporated 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.
**************************************************************************************************/
/* ------------------------------------------------------------------------------------------------
* Includes
* ------------------------------------------------------------------------------------------------
*/
#include
#include
#include
#include "twi_master.h"
#include "app_timer.h"
#include "AskCrc.h"
#include "mag3110.h"
#include "m24c64.h"
#include "nrf_log.h"
#include "nrf_delay.h"
#if NRF_MODULE_ENABLED(BLE_STANDBY)
#include "dev_config.h"
#endif
/* -----------------------------------------------------------------------------
* Macros and constants
* ------------------------------------------------------------------------------
*/
/* -----------------------------------------------------------------------------
* Local Variables
* ------------------------------------------------------------------------------
*/
APP_TIMER_DEF(mag3110_timer);
static volatile uint32_t mag3110_event = 0;
static uint8_t mag3110_address = MAG3110_IIC_ADDRESS;
static int32_t x,y,z;
static uint8_t per_second = 5;
static sensor_infor_t my_sensor = {0, UNINIT, 0, 0};
static mag3110_state_t mag3110_state = SENSOR_UNINIT;
static sensor_config_t my_config = {0,};
static sample_data_t temp_data;
static uint32_t peak_sample_cnt, peak_in, peak_out;
extern void restart_mag3110_timer(bool hi_speed);
static bool mag3110_read_xyz(int16_t *x, int16_t *y, int16_t *z);
/*******************************************************************************
* @fn sensorReadReg
*
* @brief This function implements the I2C protocol to read from a sensor.
* The sensor must be selected before this routine is called.
*
* @param addr - which register to read
* @param pBuf - pointer to buffer to place data
* @param nBytes - numbver of bytes to read
*
* @return TRUE if the required number of bytes are received
******************************************************************************/
static bool sensor_read_reg(uint8_t addr, uint8_t *pBuf, uint8_t nBytes)
{
bool transfer_succeeded;
transfer_succeeded = twi_master_transfer(mag3110_address, &addr, 1, TWI_DONT_ISSUE_STOP);
transfer_succeeded &= twi_master_transfer(mag3110_address|TWI_READ_BIT, pBuf, nBytes, TWI_ISSUE_STOP);
return transfer_succeeded;
}
/*******************************************************************************
* @fn sensorWriteReg
* @brief This function implements the I2C protocol to write to a sensor.
* The sensor must be selected before this routine is called.
*
* @param addr - which register to write
* @param pBuf - pointer to buffer containing data to be written
* @param nBytes - number of bytes to write
*
* @return TRUE if successful write
*/
static bool sensor_write_reg(uint8_t addr, uint8_t *pBuf, uint8_t nBytes)
{
uint8_t w2_data[33];
if (nBytes > 32) {
return false;
}
w2_data[0] = addr;
memcpy(&w2_data[1], pBuf, nBytes);
return twi_master_transfer(mag3110_address, w2_data, nBytes + 1, TWI_ISSUE_STOP);
}
/*******************************************************************************
* @fn sensorTestExecute
*
* @brief Run a self-test on all the sensors
*
* @param none
*
* @return bitmask of passed flags, one bit set for each sensor
*/
static bool mag3110_test(void)
{
byte val = 0;
sensor_read_reg(WHO_AM_I_REG, &val, 1);
if (val != MAG3110Q_ID) {
return false;
}
return true;
}
/*********************************************************
* Put MAG3110Q into Active Mode
*********************************************************/
static void mag3110_active(void)
{
byte val;
sensor_read_reg(CTRL_REG1, &val, 1);
val = (val & 0XFC | ACTIVE_MASK);
sensor_write_reg(CTRL_REG1, &val, 1);
}
/*********************************************************
* Put MAG3110Q into Standby Mode
*********************************************************/
static void mag3110_standby (void)
{
byte val;
sensor_read_reg(CTRL_REG1, &val, 1);
val = (val & 0XFC | STANDBY_MASK);
sensor_write_reg(CTRL_REG1, &val, 1);
}
/*********************************************************************
* @fn mag3110_init
*
* @brief mag3110初始化
*
* @param None.
*
* @return None.
*/
bool mag3110_init(bool hi_speed)
{
bool success;
byte val = 0, val1 = 0;
static bool is_hi_speed = false;
if (is_hi_speed == hi_speed) {
return false;
} else {
is_hi_speed = hi_speed;
}
mag3110_standby();
if (!mag3110_test()) {
my_sensor.sensor_state = ERROR;
return false;
}
//必须等待上次采样完成后才能设置采样周期
if (hi_speed == true) {
nrf_delay_ms(200);
val = DATA_RATE_100MS;
} else {
nrf_delay_ms(100);
val = DATA_RATE_200MS;
}
if (val == DATA_RATE_100MS) {
per_second = 1000 / (100 * SAMPLE_WINDOW);
} else if (val == DATA_RATE_200MS) {
per_second = 1000 / (200 * SAMPLE_WINDOW);
}
success = sensor_write_reg(CTRL_REG1, &val, 1);
sensor_read_reg(CTRL_REG1, &val1, 1);
#if NRF_MODULE_ENABLED(BLE_STANDBY)
ble_printf("write %02x, read %02xrn", val, val1);
#endif
val = AUTO_MRST_EN_MASK;
success = sensor_write_reg(CTRL_REG2, &val, 1);
mag3110_active();
restart_mag3110_timer(hi_speed);
return success;
}
/*********************************************************************
* @fn mag3110_read_xyz
*
* @brief 读取xyz三轴的值
*
* @param None.
*
* @return None.
*/
static bool mag3110_read_xyz(int16_t *x, int16_t *y, int16_t *z)
{
uint8_t val = 0;
uint8_t t_data, data;
if (sensor_read_reg(STATUS_00_REG, &val, 1) == false) {
*x = 0;
*y = 0;
*z = 0;
return false;
}
//数据就绪
if (val & ZYXDR_MASK || val & ZYXOW_MASK) {
sensor_read_reg(OUT_X_MSB_REG, &t_data, 1);
sensor_read_reg(OUT_X_LSB_REG, &data, 1);
*x = ((t_data <<8) | data);
sensor_read_reg(OUT_Y_MSB_REG, &t_data, 1);
sensor_read_reg(OUT_Y_LSB_REG, &data, 1);
*y = ((t_data <<8) | data);
sensor_read_reg(OUT_Z_MSB_REG, &t_data, 1);
sensor_read_reg(OUT_Z_LSB_REG, &data, 1);
*z = ((t_data <<8) | data);
return true;
} else {
*x = 0;
*y = 0;
*z = 0;
return false;
}
}
/*********************************************************************
* @fn peak_detect_init
*
* @brief 出入过程检测初始化
*
* @param None.
*
* @return None.
*/
static void peak_detect_init(void)
{
peak_sample_cnt = peak_in = peak_out = 0;
}
/*********************************************************************
* @fn peak_detect
*
* @brief 出入过程检测
*
* @param None.
*
* @return None.
*/
static void peak_detect(void)
{
uint8_t i, j;
static uint32_t repeat_cnt = 0;
static sample_data_t last_data = {0,};
static sample_data_t peak_data[PARKING_SAMPLE];
int32_t sum;
if ((my_config.x_offset == 0) && (my_config.y_offset == 0) && (my_config.z_offset == 0) ) {
return;
}
temp_data.x = x - my_config.x_offset;
temp_data.y = y - my_config.y_offset;
temp_data.z = z - my_config.z_offset;
temp_data.d = temp_data.x * temp_data.x + temp_data.y * temp_data.y + temp_data.z * temp_data.z;
#if NRF_MODULE_ENABLED(BLE_STANDBY)
static uint32_t debug_cnt = 0;
if (++debug_cnt >= (2 * per_second)) {
debug_cnt = 0;
ble_printf("% 4d % 4d % 4d %drn", temp_data.x, temp_data.y, temp_data.z, temp_data.d);
}
#endif
//判断连续采样的数据是否值相近,相近进行过滤,最多连续10次
if ((last_data.x - temp_data.x) * (last_data.x - temp_data.x) <= 36) {
++repeat_cnt;
} else {
#if NRF_MODULE_ENABLED(BLE_STANDBY1)
if (repeat_cnt > 0) {
ble_printf("rp %drn", repeat_cnt);
}
#endif
repeat_cnt = 0;
}
//记录数据
last_data = temp_data;
if (++peak_sample_cnt > PARKING_SAMPLE) {
for (i = 1; i
}
peak_data[PARKING_SAMPLE - 1] = temp_data;
} else {
peak_data[peak_sample_cnt - 1] = temp_data;
}
j = (PARKING_SAMPLE - 1) / 2;
//寻找峰值,z轴和总的分量值,先增加后减少
if (peak_sample_cnt >= PARKING_SAMPLE && peak_data[j].d > my_config.high_threshold) {
for (i = 0; i
return;
}
}
for (i = j; i
return;
}
}
} else {
return;
}
//判断x轴的分量累计变化量
sum = 0;
for (i = 0; i
}
if (sum<30 sum="">-30) {
return;
}
//进出标志,x轴的分量连续增加或者减少
if (peak_data[0].x > peak_data[PARKING_SAMPLE - 1].x) {
for (i = 0; i
}
}
peak_in++;
peak_out = 0;
} else {
for (i = 0; i
return;
}
}
peak_out++;
}
#if NRF_MODULE_ENABLED(BLE_STANDBY)
for (i = 0; i
}
ble_printf("sum %d in %d out %drn", sum, peak_in, peak_out);
#endif
}
/*********************************************************************
* @fn mag3110_sample
*
* @brief mag3110传感器采样,读取多次的值,取平均
*
* @param None.
*
* @return None.
*/
static bool mag3110_sample(void)
{
static uint8_t sample_cnt = 0;
static int32_t x_sample = 0, y_sample = 0, z_sample = 0;
int16_t x_temp, y_temp, z_temp;
if (mag3110_read_xyz(&x_temp, &y_temp, &z_temp) == false) {
return false;
}
if ((x_temp == 0) && (y_temp == 0) && (z_temp == 0)) {
sample_cnt = x_sample = y_sample = z_sample = 0;
//mag3110_init(false);
return false;
} else {
x_sample += x_temp;
y_sample += y_temp;
z_sample += z_temp;
if (++sample_cnt == SAMPLE_WINDOW) {
x = x_sample / (SAMPLE_WINDOW);
y = y_sample / (SAMPLE_WINDOW);
z = z_sample / (SAMPLE_WINDOW);
sample_cnt = x_sample = y_sample = z_sample = 0;
return true;
} else {
return false;
}
}
}
/*********************************************************************
* @fn mag3110_sample_high
*
* @brief 判断mag3110传感器采样值是否高与阈值
*
* @param None.
*
* @return None.
*/
static bool mag3110_sample_high(void)
{
if ((my_config.x_offset == 0) && (my_config.y_offset == 0) && (my_config.z_offset == 0) ) {
return false;
}
peak_detect();
if (temp_data.d > my_config.high_threshold) {
if (temp_data.d > MIF_THESHOLD) {
my_sensor.mif = 1;
} else {
my_sensor.mif = 0;
}
return true;
} else {
my_sensor.mif = 0;
return false;
}
}
/*********************************************************************
* @fn mag3110_calibration_available
*
* @brief 判断能否对mag3110进行校准
*
* @param None.
*
* @return None.
*/
static bool mag3110_calibration_available(uint32_t cnt)
{
if ((my_config.x_offset == 0) && (my_config.y_offset == 0) && (my_config.z_offset == 0) || (temp_data.d > my_config.low_threshold)) {
return false;
}
if ((cnt >= 5 * per_second) && (cnt <= 8 * per_second)) {
return true;
} else {
return false;
}
}
/*********************************************************************
* @fn mag3110_calibration
*
* @brief 对mag3110进行校准
*
* @param None.
*
* @return None.
*/
static void mag3110_calibration(void)
{
double n;
if ((my_config.x_offset == 0) && (my_config.y_offset == 0) && (my_config.z_offset == 0) ) {
my_config.x_offset = x;
my_config.y_offset = y;
my_config.z_offset = z;
} else {
n = 0.3;
my_config.x_offset = (int32_t) (my_config.x_offset * (1.0 - n) + x * n);
my_config.y_offset = (int32_t) (my_config.y_offset * (1.0 - n) + y * n);
my_config.z_offset = (int32_t) (my_config.z_offset * (1.0 - n) + z * n);
}
}
/*********************************************************************
* @fn mag3110_recalibration
*
* @brief 对mag3110进行重新校准
*
* @param None.
*
* @return None.
*/
void mag3110_recalibration(void)
{
my_config.x_offset = 0;
my_config.y_offset = 0;
my_config.z_offset = 0;
mag3110_state = SENSOR_INIT;
my_sensor.sensor_state = INIT;
my_sensor.parking_done = 0;
mag3110_init(true);
}
/*********************************************************************
* @fn record_sensor_state
*
* @brief 对地磁状态进行记录,状态变化时上传给后台
*
* @param None.
*
* @return None.
*/
#ifdef LORA_WAN_ENABLE
static void send_sensor_state(void)
{
static uint8_t data[8] = {0}, len = 0;
static sensor_state_t last_sensor_state = INIT;
static bool send_state = false;
static uint32_t send_cnt = 0;
if (last_sensor_state != my_sensor.sensor_state) {
send_state = true;
get_geo_state(data, &len);
send_cnt = 0;
last_sensor_state = (sensor_state_t)my_sensor.sensor_state;
}
if (send_state == true) {
if (++send_cnt<20 * per_second) {
if (lorawan_send_data(true, 1, len, data) == true) {
send_state = false;
}
} else {
send_state = false;
}
}
}
#endif
/*********************************************************************
* @fn mag3110_sample_task
*
* @brief 地磁状态检测主函数
*
* @param None.
*
* @return None.
*/
void mag3110_sample_task(void)
{
static uint32_t init_cnt = 0, high_cnt = 0, low_cnt = 0, no_cnt = 0, rpt_cnt = 0;
static bool store_config = false;
#if NRF_MODULE_ENABLED(BLE_STANDBY)
static uint32_t debug_cnt = 0;
if (++debug_cnt >= (2 * per_second)) {
debug_cnt = 0;
switch (mag3110_state) {
case SENSOR_INIT:
ble_printf("INITrn");
break;
case NO_CAR_DETECTED:
ble_printf("NO_CARrn");
break;
case COUNT_HIGH:
ble_printf("HIGHrn");
break;
case CAR_DETECTED:
ble_printf("CARrn");
break;
case COUNT_LOW:
ble_printf("LOWrn");
break;
case SENSOR_UNINIT:
ble_printf("UNINITrn");
break;
default:
ble_printf("UNKNOWNrn");
break;
}
}
#endif
//对mag3110进行数字采样
if (!mag3110_sample()) {
return;
}
//进入状态机进行处理
switch (mag3110_state) {
case SENSOR_INIT:
//1.校准初始化,完成后变为无车
if (++init_cnt <(CALIBRATION_WINDOW * per_second)) {
mag3110_calibration();
} else {
init_cnt = 0;
mag3110_state = NO_CAR_DETECTED;
my_sensor.sensor_state = NO_CAR;
peak_detect_init();
set_mag3110_config();
}
break;
case NO_CAR_DETECTED:
no_cnt++;
mag3110_init(true);
//1.检测到高状态,进入COUNT_HIGH
if (mag3110_sample_high()) {
high_cnt = 1;
mag3110_state = COUNT_HIGH;
} else if (mag3110_calibration_available(no_cnt)) {
mag3110_calibration();
store_config = true;
}
if (store_config == true) {
if (no_cnt >= 8 * per_second) {
set_mag3110_config();
store_config = false;
}
}
peak_in = peak_out = 0;
my_sensor.parking_done = 0;
break;
case COUNT_HIGH:
//1.高状态计数大于计数阈值H是跳到有车状态CAR_DETECTED,否则继续计数
//2.否则出现采样值为低状态时,进入COUNT_LOW状态
mag3110_init(true);
if (mag3110_sample_high()) {
if (++high_cnt >= (my_config.detect_interval * per_second)) {
mag3110_state = CAR_DETECTED;
my_sensor.sensor_state = CAR;
my_sensor.parking_done = 0;
}
} else {
low_cnt = 1;
mag3110_state = COUNT_LOW;
}
break;
case CAR_DETECTED:
//1.判断采样值是低状态,是进入到COUNT_LOW
if (!mag3110_sample_high()) {
low_cnt = 1;
mag3110_state = COUNT_LOW;
}
peak_in = peak_out = 0;
break;
case COUNT_LOW:
//1.低状态计数大于计数阈值L是跳到无车状态NO_CAR_DETECTED,否则继续计数
//2.否则出现采样值为高状态时,进入COUNT_HIGH状?
if (mag3110_sample_high()) {
high_cnt = 1;
mag3110_state = COUNT_HIGH;
} else {
if (++low_cnt >= (my_config.detect_interval * per_second)) {
//1.降锁后一直没有车停入,2.检测到有车开出去
if ((peak_in == 0 && peak_out == 0) || (peak_out > 0)) {
mag3110_state = NO_CAR_DETECTED;
my_sensor.sensor_state = NO_CAR;
no_cnt = 0;
} else if (peak_in > 0 && peak_out == 0) {
my_sensor.sensor_state = CAR;
my_sensor.parking_done = 1;
}
}
}
break;
case SENSOR_UNINIT:
//异常复位恢复
if ((my_config.x_offset != 0 && my_config.y_offset != 0 && my_config.z_offset != 0)) {
mag3110_state = COUNT_LOW;
}
break;
default:
break;
}
}
static void mag3110_timer_envent(void * p_context)
{
mag3110_event = 1;
}
/*********************************************************************
* @fn mag3110_event_handler
*
* @brief mag3110事件处理
*
* @param None.
*
* @return None.
*/
void mag3110_event_handler(void)
{
if (mag3110_event) {
mag3110_sample_task();
mag3110_event = 0;
}
}
/*********************************************************************
* @fn mag3110_start
*
* @brief mag3110初始化函数
*
* @param None.
*
* @return None.
*/
void mag3110_start(void)
{
ret_code_t err_code;
err_code = app_timer_create(&mag3110_timer, APP_TIMER_MODE_REPEATED, mag3110_timer_envent);
APP_ERROR_CHECK(err_code);
//err_code = app_timer_start(mag3110_timer, APP_TIMER_TICKS(100) , NULL);
//APP_ERROR_CHECK(err_code);
get_mag3110_config();
mag3110_init(true);
}
/*********************************************************************
* @fn restart_mag3110_timer
*
* @brief mag3110定时器重置
*
* @param None.
*
* @return None.
*/
void restart_mag3110_timer(bool hi_speed)
{
uint32_t err_code;
uint32_t delay;
if (hi_speed == true) {
delay = 100;
} else {
delay = 200;
}
// Stop application timers.
err_code = app_timer_stop(mag3110_timer);
APP_ERROR_CHECK(err_code);
//增加5ms延时
nrf_delay_ms(2);
// Start application timers.
err_code = app_timer_start(mag3110_timer, APP_TIMER_TICKS(delay) , NULL);
APP_ERROR_CHECK(err_code);
}
优势系列品牌:All sensors、Honeywell、Freescale、SMI、GE Nova sensor、Sensirion压力传感器, PNI地磁传感器(ASIC驱动控制器MagI2C芯片13156 Sen-XY轴传感器13104 Sen-Z轴传感器)、电子罗盘TCM-XB PN12810,iSentek爱盛地磁传感器IST8308 IST8310 IST8315,Positronic、ERNI连接器,Posifa流量传感器、真空传感器。 深圳盛思瑞创科技有限公司是进口连接器及进口传感器销售商,并集产品方案推广、技术支持、销售服务为一体的销售型公司,公司专注于传感器 、连接器、单片机MCU在物联网、汽车、工业、交通运输、LED、医疗、消费电子、通信等市场领域的设计开发应用,以及整体产品技术解决方案的推广。
点击查看>| 企业类型 | 私营有限责任公司 | 注册资本 | 500.00万人民币 |
| 公司注册地址 | 北京市昌平区科技园区振兴路28号绿创科技大厦5层B520室 | 统一社会信用代码 | 91440300MA5G9TBE3H |
| 登记机关 | 北京市工商行政管理局昌平局 | 法定代表人 | 汤波 |
| 公司成立日期 | 2016-09-22 | 营业期限 | 2016年09月22日至2046年09月21日 |
| 经营范围 | 技术了开发、技术咨询、技术服务。销售电子元器件。 | ||




