你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

基于STM32CUBEMX驱动TMOS模块STHS34PF80修改检测阈值(3)

[复制链接]
攻城狮Melo 发布时间:2023-11-16 17:09
套件概述2 V/ X# M4 P% s0 E% L3 k' m9 q
用于配置和设置 STHS34PF80 传感器的一些参数,以便进行存在检测和运动检测。
1 m5 d& y( h2 f: t/ L1 w" B+ ^; A2 R. Q( \$ R. g
微信图片_20231116161600.png $ J7 b% Q4 @2 F% P+ l. _" `

& _$ Z9 Q% b& w7 i6 s# q/ M7 X; [参考程序初始化
: y) H0 W: w" x9 H+ e: y. n相对于驱动人体检测demo,新的案例设置了传感器的存在和运动相关的阈值、滞后和中断配置,以实现存在检测和运动检测的功能,并在相关事件发生时触发中断。: Z6 p3 @5 e8 ~# E* w4 K7 ?

" q) j3 X5 `  F' M" M 1.png
9 @5 l/ E$ L9 l  B- y+ R
4 l  f7 [5 T! {4 G% w2 O省电模式
+ _8 o! f0 y. @2 T: n- i下面文本描述了关机模式的使用和功能。关机模式是一种休眠模式,用于将传感器设备置于休眠状态,从而节省功耗。在关机模式下,设备停止数据采集,并且大部分内部模块都被关闭,以最小化电流消耗。这使得传感器在供电的情况下能够实现最低的功耗水平。2 {0 x5 l6 a* {6 A6 g
1 c0 X6 B, p) X0 S
尽管设备处于关机模式,但它仍保持 I²C / SPI 通信串口处于活动状态,以便能够与设备进行通信和配置设置。关机模式下,配置寄存器的内容被保留,而输出数据寄存器不会更新,这意味着在进入关机模式前,最后一次采样的数据将保留在内存中。% S/ C1 i5 U- z3 e; S* w

: o3 C" i, J/ N0 h0 g9 y  P  D# T为了进入关机模式并避免在重新进入连续模式时读取错误的输出数据,文本提供了正确的步骤。然而,这些步骤在你的问题中并未提供,因此无法给出完整的步骤。/ t, o- G) ]% c4 t3 U, a  Z! x

. C, S3 e8 t- e
2.png
7 G) m# j0 L7 k1 K
/ w4 u# u- y+ \. n
上面文档主要对0x25,0x23,0x20寄存器进行操作,其中读取0x25多次,主要功能是对STATUS (23h)的DRDY进行清0。* j( I& O. r7 A; h

0 r( o4 T6 F" p查看下面表格也可以得知,有多种操作可以对STATUS (23h)的DRDY 清零。; |( U2 T8 r3 n8 D, j& I0 Y- h
; \% {% F. n- _( d/ d1 L+ ^: x
3.png : \' G1 d( y" |" ~" Z- y9 Z5 p

2 Y9 z7 x3 f! I" u* a$ E5 v' {其中0x20是配置速率寄存器。
2 e2 A# [5 P' y# V2 ^# R, c7 y6 B% ?2 U) L% C  t! n3 g
4.png
1 z' ?' h- ^( k
1 f. C' q1 ^" ]/ `3 J. q设置存在阈值
2 s; M) @* T7 z. r. `存在检测如下所示。
3 N, A: ]+ V! h% e) D
# g- C5 Q- ?# w 5.png
) {, L/ t5 `# a& S3 s
  X7 j; Z1 p7 E; w3 r( |! O/ c
以设置存在阈值为例,探索设置的步骤。
( M# Q, _  O# U  O1 \7 m3 a- J) K) F( L5 V+ O9 L6 i
6.png
) E- }. C6 t( b. W; U8 r' M. k; {$ ]8 l- s* y
这里使用的函数为 sths34pf80_presence_threshold_set(STHS34PF80_ADDRESS, 200)。
  1. /**2 i/ |0 ~) g; ^& h9 U3 `, B
  2.   * @brief  Presence threshold.[set]
    0 p% [- `" a  k; F
  3.   *
    # z$ f% k! g2 ^0 q: ~  b" j$ b( M. C
  4.   * @param  ctx      read / write interface definitions! E3 y. Z+ l& v* f+ G, D
  5.   * @param  val      presence threshold level
    2 ^6 e. C5 ^4 G
  6.   * @retval          interface status (MANDATORY: return 0 -> no Error); M6 R+ }% K- y/ Q+ d9 ?
  7.   *3 F1 @; s4 ]: ?. R/ L1 B* q
  8.   */1 T. ?- x' O9 ?. E
  9. uint8_t sths34pf80_presence_threshold_set(uint8_t add, uint16_t val), q0 a! r3 z( @4 V  G
  10. {
    7 r+ B/ U7 q3 t. i$ f+ P% k$ V
  11.   sths34pf80_ctrl1_t ctrl1;
    1 k) M9 d' I% o  \- x6 J
  12.   uint8_t odr;* Y6 |  v5 D. S; p. D% l
  13.   uint8_t buff[2];
    . a! z; P, s: W) A4 V5 n9 L
  14.   int32_t ret;8 A  y5 t5 W3 s$ t8 z! Z2 f0 Z

  15. 2 D- ]0 P  i; Y) r* |' `' J0 v- f
  16.   if ((val & 0x8000U) != 0x0U) {) |# Z5 P# J/ s0 a1 Q
  17.     /* threshold values are on 15 bits */
    ' U  U9 t; _( }
  18.     return -1;
    8 X3 B, r1 w; Y% O# f6 ~
  19.   }' T- W5 c9 R0 e, e9 p* U  |
  20. ! s2 |' Z3 L, y1 z' s. I( T9 g
  21.   /* Save current odr and enter PD mode */
    $ {7 O; r% A- i1 ~3 J
  22.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x201 k# r6 |/ a0 o6 ^: q% t/ V% o
  23.   odr = ctrl1.odr;; }4 i) m2 h: p$ r, E" v8 N
  24.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0);
    : @% k5 D8 D. ?! W" u! J3 J

  25. 8 }# Z8 H# `, I4 _
  26.   buff[1] = (uint8_t)(val / 256U);
    ; ?3 a2 t9 W! W9 Q# z& i
  27.   buff[0] = (uint8_t)(val - (buff[1] * 256U));* }" k0 t: m/ _3 |" l7 K; o* x/ c
  28.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_PRESENCE_THS, &buff[0], 2);//STHS34PF80_PRESENCE_THS->0x20U
    . n8 S  }- m3 s+ K+ d% y7 n

  29. 8 k4 A3 ]. a. O0 H7 p5 h5 b$ Z
  30.   ret += sths34pf80_algo_reset(add);; c+ P, ]9 ^' D( Z( I

  31. 2 \* @* L1 ?$ p! ^( H
  32.   /* Set saved odr back */
    ' F" S1 M" m$ p: S* s
  33.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
    - }) f' g8 M+ f" J  C# o

  34. ' d! k% y9 J9 j
  35.   return ret;
    ; B; l6 T: m+ B, R% Q
  36. }2 ]! d. q& T) f8 m* f% B
复制代码
6 |' A4 a: c& `- L
最开始读取CTRL1(20h)的数据,同时进行保存到odr变量中。
  1.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x20
    # J& _; J+ e- [2 n
  2.   odr = ctrl1.odr;; ]# P0 I3 e, y, \6 _
复制代码

1 w* T# T) }" e, Kret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0)这行代码用于在设置存在阈值之前,通过调用 sths34pf80_tmos_odr_check_safe_set 函数来确保在设置新的参数之前传感器的状态是稳定且安全的。该函数如下所示。
  1. /**3 M0 }- r2 q" V! @3 u
  2.   * @brief  Enter to/Exit from power-down in a safe way& {; e" N6 B, m/ _
  3.   *4 `. Z/ ?* l. ]1 i6 ^) `
  4.   * @param  ctx      read / write interface definitions
    % I$ x1 a. M1 x$ T% z1 J
  5.   * @param  ctrl1    Value of CTRL1 register  D$ K" o5 D* F/ p3 D8 C. D
  6.   * @param  odr_new  Value of new odr to be set
    - T3 p" z3 e# G% ~  k4 U8 }) y% ?% @
  7.   * @retval          interface status (MANDATORY: return 0 -> no Error)
    - u2 ?& v' a8 U" D4 @
  8.   *- ]* ], g- i# ]& c( p  I3 W9 }
  9.   *// e) k! l! p- J; m
  10. static uint8_t sths34pf80_tmos_odr_check_safe_set(uint8_t add,sths34pf80_ctrl1_t ctrl1, uint8_t odr_new)
    1 s5 f& z4 o9 \- J, B; C7 r% Q
  11. {
    ! i) S+ }# u4 t: t1 c: T
  12.   sths34pf80_func_status_t func_status;1 r6 X' r4 U& W: V& `) G
  13.   sths34pf80_tmos_drdy_status_t status;) d% A4 b  _) I9 L7 n
  14.   int32_t ret = 0;
    ( s7 i+ B5 J7 v; D5 W

  15. * p5 B% R& Y4 n( d' H* F
  16.   if (odr_new > HAL_OK) {' y- K% C1 g* ?
  17.     /*
    ! h5 j1 T( ?; u7 _  a3 e2 K8 i' l/ g
  18.      * Do a clean reset algo procedure everytime odr is changed to an
    ! u" f8 i9 z# {, h2 I% [- u- y
  19.      * operative state.
    - r% _6 F# M# r1 B2 L
  20.      */
    & Z( w8 P# A' D$ l
  21.     ctrl1.odr = 0;
    ( w( y; f* U9 _  w
  22.     ret = sths34pf80_write_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x209 h! @+ t  @. ~
  23. & @: K) m! F5 g
  24.     ret += sths34pf80_algo_reset(add);
    4 I& E* P0 q0 O: |; i2 u
  25.   } else {5 z% g- I$ r3 S
  26.     /* if we need to go to power-down from an operative state) q# e: R+ F. q7 V
  27.      * perform the safe power-down.6 O7 F6 d7 d) D1 h/ i; I  a
  28.      */
    6 O9 G# V5 k! ]& Z' ?2 u
  29.     if ((uint8_t)ctrl1.odr > 0U) {2 `( \  n) L* Q
  30.       /* reset the DRDY bit */
    , t' J$ j1 E7 q( ?$ F; v1 w! t+ G
  31.       ret = sths34pf80_read_reg(add, STHS34PF80_FUNC_STATUS, (uint8_t *)&func_status, 1);//STHS34PF80_FUNC_STATUS->0x25
    : T, t; _! B% z/ `( H* e

  32. 7 v: [" P$ y0 [* ], h" D
  33.       /* wait DRDY bit go to '1' */) v! N4 i: }4 g4 `" `) W" P
  34.       do {
    2 S- `1 P- Y, }! ~9 {/ w% F5 g
  35.         ret += sths34pf80_tmos_drdy_status_get(add, &status);; k! t, |/ v/ _/ y  Q! a

  36. 0 i0 S0 @$ F6 O, m5 t0 a/ p: R& e/ _
  37.       } while (status.drdy != 0U);: U7 c6 q( B' u  X1 D

  38. # `1 F% t: N! t7 g9 R% H! T
  39.       /* set ODR to 0 */' T! V% D; {6 F' e% ?1 x
  40.       ctrl1.odr = 0;2 M$ T* L# i. E0 u
  41.       ret += sths34pf80_write_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);
    6 ^' K( B+ J0 }4 `: J6 S6 P. [

  42. 0 |$ ]& h5 N" q. m. d: V6 S
  43.       /* reset the DRDY bit */
    + s7 p% B2 n, t6 }* `% ~2 a8 B* ^5 l
  44.       ret += sths34pf80_read_reg(add, STHS34PF80_FUNC_STATUS, (uint8_t *)&func_status, 1);
    / ~, c1 Y, Y& v% t) s- t9 \- m
  45.     }7 A# F. R# c; K- g/ L3 J
  46.   }
    & G+ q! L3 \7 r9 N
  47. 5 |0 K6 _% D" V- L9 d/ A
  48.   ctrl1.odr = (odr_new & 0xfU);# {' w8 m: `  V, J" J" ^
  49.   ret += sths34pf80_write_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);1 W. ]. a- L: u- @) F1 R% k, j0 a# p

  50. . [+ Z4 N2 Y$ V- `% x
  51.   return ret;
    ; N, a3 W0 t% k9 `/ t
  52. }
复制代码

9 R6 w6 S/ R  l4 k" u9 n其中下电模式在else中执行。& H, K5 Q* n5 S4 ?
先是执行sths34pf80_read_reg(add, STHS34PF80_FUNC_STATUS, (uint8_t *)&func_status, 1),读取0x25主要功能是对STATUS (23h)的DRDY进行清0,之后执行如下代码。
  1.       /* wait DRDY bit go to '1' */
    1 z% y. i0 j3 W3 b+ J$ K  O
  2.       do {+ Y% ?0 O0 D: l* A* }
  3.         ret += sths34pf80_tmos_drdy_status_get(add, &status);( ~# i2 U0 O( p$ @) _

  4. $ s+ n, g4 O+ W1 r. c9 W
  5.       } while (status.drdy != 0U);
    ( ^; M5 @: L4 {' ~+ Z- q
复制代码
2 i1 D1 ?/ k9 q8 p
sths34pf80_tmos_drdy_status_get代码主要是对STATUS (23h)的DRDY进行读取,当读取为0,跳出上面的循环。
  1. /**
    7 i. d! T4 o  @- I
  2.   * @brief  status of drdy.[get]& S( A, w8 n" p9 C9 h3 }9 ^' W  ?
  3.   *
    # l6 R' N* n9 d& Y' F$ {
  4.   * @param  ctx      read / write interface definitions$ T0 M1 [; s& v8 l
  5.   * @param  val      status of drdy bit (TAMB, TOBJ, TAMB_SHOCK, TPRESENCE, TMOTION).6 N+ \2 ]/ n% v1 A# q/ z, o; L# M0 v  N
  6.   * @retval          interface status (MANDATORY: return 0 -> no Error)! {6 K/ T. Q- l9 e7 a8 l
  7.   *9 i, n0 S) l' I9 J
  8.   */
    , S+ O9 w" h, v8 E6 A
  9. uint8_t sths34pf80_tmos_drdy_status_get(uint8_t add, sths34pf80_tmos_drdy_status_t *val)
      ?( `$ S, g; c$ d. @1 G
  10. {
    ' c" b' \# f( U! i1 ], y2 c
  11.   sths34pf80_status_t status;# G$ |( B9 }8 Z: R  [8 ^& N
  12.   int32_t ret;
    . t! [% @9 _5 Z# a

  13. ; I. K, M6 C7 ~- ?0 r6 W) `
  14.   ret = sths34pf80_read_reg(add, STHS34PF80_STATUS, (uint8_t *)&status, 1);//STHS34PF80_STATUS->0x23  }* k+ Q/ g/ X' p. s

  15. 9 g0 F0 \! f) e$ O7 u
  16.   val->drdy = status.drdy;& s  W" M# G+ V5 X, U% r

  17. # r/ f4 l) q2 y# E7 C* g
  18.   return ret;
    8 U( l, `4 d1 X- N, e8 `* M
  19. }0 ~- f6 Q6 v  ?9 @
复制代码

, l$ d" y/ J% K; O% C. r之后重新回到sths34pf80_tmos_odr_check_safe_set函数中,执行如下操作。- r, C. V0 h+ y
主要功能就是将CTRL1(20h)里面的ODR数据清零,同时读取0x25,主要功能是对STATUS (23h)的DRDY进行清0
  1.       /* set ODR to 0 */
    4 I( E9 U" S* s& j7 B: {0 ?! ^; H
  2.       ctrl1.odr = 0;; g! h) g! z# I) t
  3.       ret += sths34pf80_write_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x20! Z: T1 V$ H7 l# N# H
  4. 8 e/ X) F$ g# l8 I
  5.       /* reset the DRDY bit */
    4 S# ]/ `4 B9 w7 j
  6.       ret += sths34pf80_read_reg(add, STHS34PF80_FUNC_STATUS, (uint8_t *)&func_status, 1);//STHS34PF80_FUNC_STATUS->0x25
    0 c# t6 r9 x, [
复制代码

! I  c: q" q9 q6 K* A8 \. N% v然后执行如下代码将ODR数据重新写入CTRL1(20h)寄存器中。
  1.   ctrl1.odr = (odr_new & 0xfU);
    4 V8 k# T* A7 G% u
  2.   ret += sths34pf80_write_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x20+ a, L3 n. [$ X  A  ]
复制代码

% E" \) p" O* R9 M( U2 X紧接着返回sths34pf80_presence_threshold_set函数中,执行如下操作。
3 p, K2 z/ x- L$ e$ M1 s' j, V1 ~3 z将传入的数据保存到buff数组中,然后执行sths34pf80_func_cfg_write将buff数据传入到PRESENCE_THS (20h - 21h)中。- K) C) a( Z3 C# o/ d' F" s
  1. buff[1] = (uint8_t)(val / 256U);+ ?( @& M% T# k$ g  |; |5 y! n
  2.   buff[0] = (uint8_t)(val - (buff[1] * 256U));
    " V: d" B' m  c+ U. a' z1 n/ [3 d
  3.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_PRESENCE_THS, &buff[0], 2);//STHS34PF80_PRESENCE_THS->0x20U
复制代码
5 |( u6 k$ H1 f
查看sths34pf80_func_cfg_write函数,如下所示。
  1. /**
      B; ]  I& C3 O
  2.   * @brief  Function Configuration write
    3 n2 R# U9 z& v" f  U, h
  3.   *7 h7 N# i$ s7 W/ \! n% O# r
  4.   * @param  ctx      read / write interface definitions
    3 l. [# K- O! t8 D' [" o
  5.   * @param  addr     embedded register address' P% y& A. F7 W6 S- J
  6.   * @param  data     embedded register data
    + o$ m1 A0 x( P
  7.   * @param  len      embedded register data len& D& `6 N) p; U' [
  8.   * @retval          interface status (MANDATORY: return 0 -> no Error). K: Q' V( r2 ?
  9.   *: E3 E9 r+ A0 E& B2 ]7 W  R2 H+ x
  10.   */. T: o, o1 u* P' P* Y: Y+ ^9 N
  11. uint8_t sths34pf80_func_cfg_write(uint8_t add, uint8_t addr, uint8_t *data, uint8_t len)2 L# X% b1 E. o
  12. {
    ' v8 F& w( M* p
  13.   sths34pf80_ctrl1_t ctrl1;
    . Y1 n- m# \6 @
  14.   uint8_t odr;
    + O. N- H0 s" E
  15.   sths34pf80_page_rw_t page_rw = {0};
    & w" c. E1 h5 Y/ \. K! L4 m' Z' ^) U
  16.   int32_t ret;+ o! q- o. T& c7 f; T0 J
  17.   uint8_t i;0 U# _& ]0 ^5 I# o& u- ^

  18. . L. K: Q" Q4 I2 N. {+ c
  19.   /* Save current odr and enter PD mode */2 L- P  ]3 u/ V0 N
  20.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x20
    " Z6 R9 R+ E1 v- D, Z
  21.   odr = ctrl1.odr;% r4 D! s/ Q  X. U+ I1 f
  22.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0);
    2 `; p) X1 l' @; V

  23. 3 p: C; w8 \% Y0 n
  24.   /* Enable access to embedded functions register */) m) A0 j/ Q5 t- F7 M' ?
  25.   ret += sths34pf80_mem_bank_set(add, STHS34PF80_EMBED_FUNC_MEM_BANK);1 r+ d8 V4 X, h, ~3 h+ n
  26. . c( G3 S$ u& C6 p6 ^' y; B: _* Q
  27.   /* Enable write mode */
    7 T/ u3 C" a# U- q6 m) P" {* G
  28.   page_rw.func_cfg_write = 1;
    9 ]. V/ S' |  g7 F3 `! T
  29.   ret += sths34pf80_write_reg(add, STHS34PF80_PAGE_RW, (uint8_t *)&page_rw, 1);
      q- M" D; K, P3 P: A6 f
  30. + F) L, G- s( B3 z/ A$ x/ R
  31.   /* Select register address (it will autoincrement when writing) */
    ) F. r4 q& Y8 E6 g
  32.   ret += sths34pf80_write_reg(add, STHS34PF80_FUNC_CFG_ADDR, &addr, 1);
    / [% m* K# z0 I+ v5 I  ^

  33. : }. b4 J" ]! Y
  34.   for (i = 0; i < len; i++)/ h4 p$ O6 W- O2 D; Q; A
  35.   {
      ~' L+ v8 I+ u! o7 Y- \
  36.     /* Write data */
    1 S5 o/ d7 A4 R1 x
  37.     ret += sths34pf80_write_reg(add, STHS34PF80_FUNC_CFG_DATA, &data[i], 1);
    2 G" i" d' J# f" ^
  38.   }
    * y6 I* _' ~( @% d  E
  39. % Z' B/ c* j1 N1 U
  40.   /* Disable write mode */
    7 X# P; s. ~6 S! b1 R( @- o: _) T6 N
  41.   page_rw.func_cfg_write = 0;# d/ S6 D7 b6 J
  42.   ret += sths34pf80_write_reg(add, STHS34PF80_PAGE_RW, (uint8_t *)&page_rw, 1);" `+ O; E1 @& Y) i) p) W
  43. ( R6 |$ L5 C1 Y
  44.   /* Disable access to embedded functions register */+ V5 W- E2 r6 k/ F9 }+ O2 v
  45.   ret += sths34pf80_mem_bank_set(add, STHS34PF80_MAIN_MEM_BANK);
    $ ^0 z6 [; ?: x" Z$ y, J) p! L
  46. * r; b6 C4 T# o  Y0 Z) \, O2 u
  47.   /* Set saved odr back */
    : B! {, t7 n% @( m+ B
  48.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
    1 p6 T% z8 Y: I

  49. $ v1 e# s0 ~0 ^/ E' ^
  50.   return ret;
    $ r# ]: ^: V( d$ }' G, ~7 m
  51. }
复制代码

! j1 u- ^( R: C分析上面代码,其中sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1)为将ODR数据读取出来,接着执行sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0),该函数上面已经讲解,主要是进入一个掉电模式,确保在设置新的参数之前传感器的状态是稳定且安全的,以防止设置参数时出现异常情况。接着执行sths34pf80_mem_bank_set(add, STHS34PF80_EMBED_FUNC_MEM_BANK),该函数具体操作如下所示。
  1. /**
    * H% p3 S* Q: B+ a/ Q% d& d
  2.   * @brief  Change memory bank.[set]
    . `" e9 U/ Z) K5 F! [
  3.   *) d1 c) ?, O4 j& ?, f4 a
  4.   * @param  ctx      read / write interface definitions% R" T9 |( D$ U9 C( `" d( l2 F
  5.   * @param  val      MAIN_MEM_BANK, EMBED_FUNC_MEM_BANK, SENSOR_HUB_MEM_BANK, STRED_MEM_BANK,
    . E6 F- r8 Z/ D2 u9 t
  6.   * @retval          interface status (MANDATORY: return 0 -> no Error)
    3 K5 ^* v. ]& I1 ~6 N9 E: j
  7.   *
    ! O9 N+ o( }* f
  8.   */2 G7 K0 I$ I$ v! c
  9. uint8_t sths34pf80_mem_bank_set(uint8_t add, sths34pf80_mem_bank_t val)- `# V6 D) f( S$ |9 e2 j
  10. {3 {% o& V. a% x3 e
  11.   sths34pf80_ctrl2_t ctrl2;
    2 M8 [1 z! _4 X8 D
  12.   int32_t ret;" v7 D  s/ ?% n  `2 G* I+ y' i

  13. & X) A' ^' x! c  X; e$ l4 @: {* \
  14.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL2, (uint8_t *)&ctrl2, 1);//STHS34PF80_CTRL2->0x21
    : X' {2 Q& M! J% c( D  ^3 o# h

  15. : u5 C  p% n& }$ F- }( H" f
  16.   if (ret == HAL_OK)7 ^! Y& e9 P  s
  17.   {
    4 c0 E' `$ b% q
  18.     ctrl2.func_cfg_access = ((uint8_t)val & 0x1U);
    7 I  p& i6 J  I
  19.     ret = sths34pf80_write_reg(add, STHS34PF80_CTRL2, (uint8_t *)&ctrl2, 1);//STHS34PF80_CTRL2->0x21
    % \8 X6 s. i& r! j5 H; K! c
  20.   }
    ) C& [( a0 g5 E4 z( N
  21. ; D+ ^1 ?- [' ?/ f& X0 O& a9 Y
  22.   return ret;
      Y- z- V7 m8 h0 B: B) [! e$ a
  23. }
复制代码
  1. CTRL2 (21h)如下所示,对FUNC_CFG_ACCESS设置为1主要是开启访问内嵌函数寄存器。, q+ k: H2 H& s& L

  2. $ D; m8 ?5 |: A/ E& r0 Y: o8 s
  3. 9 I/ B5 E0 _' r6 K
  4. 继续返回sths34pf80_func_cfg_write函数,' [7 w5 ^6 N8 F: z% S: ^  [; w- ]! S8 L
  5. 之后执行如下函数,主要为向寄存器PAGE_RW (11h)的FUNC_CFG_WRITE标志位置为为1,启用嵌入式函数的写过程。
复制代码
  1.   /* Enable write mode *// n, }- X2 @' j" ^; h% l
  2.   page_rw.func_cfg_write = 1;( P& d& H7 z! k' m" J" R0 l
  3.   ret += sths34pf80_write_reg(add, STHS34PF80_PAGE_RW, (uint8_t *)&page_rw, 1);
    , O# x4 z+ C0 B6 d. N) |6 a
复制代码
/ M0 ]2 m- k7 @/ l$ e, Y8 N# P$ `5 d. R
7.png
8 X: ~' g) ^! k  I+ I& A% G/ q
; o$ |% c% s  ?) |' e, N1 \继续返回sths34pf80_func_cfg_write函数,然后执行如下函数,该函数为写入或者读取嵌入式函数的地址,具体要看PAGE_RW (11h)设置为读或者写,同时写入固定的data指令,当写完之后进入PAGE_RW (11h)关闭读或写操作。
. N/ U/ M5 |% S" J6 k. q; f* |$ c9 X
  1.   /* Select register address (it will autoincrement when writing) */9 a) K0 N# j* v, Q" T& C; s
  2.   ret += sths34pf80_write_reg(add, STHS34PF80_FUNC_CFG_ADDR, &addr, 1);- W- |( ?  _% n1 N7 l
  3.   for (i = 0; i < len; i++)
    ! k! b2 W  o& H$ H3 c2 ^( |
  4.   {- ]- ^; t% D! @4 P) z0 m8 H2 N
  5.     /* Write data */& ^8 Z) u, M* ~- x, |
  6.     ret += sths34pf80_write_reg(add, STHS34PF80_FUNC_CFG_DATA, &data[i], 1);
    ! l4 r+ X6 T0 e4 ~: B
  7.   }1 o5 s- U5 y) b4 |9 g
  8.   /* Disable write mode */  g  a, P0 Y: M7 ]% u6 d; S
  9.   page_rw.func_cfg_write = 0;. s) b# a! |% d, `. G& O& H
  10.   ret += sths34pf80_write_reg(add, STHS34PF80_PAGE_RW, (uint8_t *)&page_rw, 1);
复制代码

/ l/ I' s0 t- h 8.png 5 {$ y% l+ Y. M+ f/ A8 I
9 F+ R1 }  O" ?, F0 A) w. k
这里传入的地址addr为STHS34PF80_PRESENCE_THS,这是个15位的寄存器,PRESENCE_THS 寄存器(地址范围为 0x20 到 0x21)主要用于存在检测算法的存在阈值设置。存在检测算法用于判断是否存在某种状态或条件,通常与传感器测量数据相关。' |+ C/ m/ R" e1 j, Q
7 H. O9 \$ {$ X2 W! f/ I3 r# z' W6 r# I

5 c9 I- f& E+ o( l! d" A& n具体解释如下:/ X  R4 v- l. \/ U/ d
存在阈值(Presence Threshold): 这是一个用于存在检测算法的阈值。阈值定义了在测量数据中何时认为存在某种条件。在这里,阈值是一个 15 位的无符号整数(范围在 0 到 32767 之间)。
/ |" r8 P2 M" z/ w% H3 r
* W: @) O6 T' o- Z$ l% H! Q

3 G& ^/ X* {0 j' j  Y默认值: 预设的存在阈值默认值是 200(0x00C8)。
' ]+ K3 m) D; Y- Q+ E) U
# X) [+ O' h: W; Z* { 9.png 1 @/ ~. {4 C. F; d3 a" Z
0 l) U9 ~; a8 l
接着执行sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr),将odr重新写入。
4 s3 i- ?9 W$ D
6 o7 i  L8 e3 \( l$ H
  1.   /* Set saved odr back */' j: E0 g& r+ R+ w3 M8 ^
  2.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
    1 _5 g6 y$ x0 B' ^0 W
复制代码
6 F) Z" F# C# B, n  R% u
到此sths34pf80_func_cfg_write就已经设置完毕,返回sths34pf80_presence_threshold_set函数中,执行sths34pf80_algo_reset操作。8 G) W/ H1 q3 h

) ~/ X! N7 e: V. p
  1.   ret += sths34pf80_algo_reset(add);
复制代码
3 S- D( [" D$ y
该函数具体操作如下所示。
  1. /**
    4 D0 |7 T4 D$ _# _
  2.   * @brief  Reset algo' E  y* B6 w) b, s" O7 Q
  3.   *
    ' X, n9 P2 J4 P9 Y- P
  4.   * @param  ctx      read / write interface definitions' t4 v# t9 T" z& K
  5.   * @param  val      reset algo structure
    & _. r2 H; `/ ~4 k( U
  6.   * @retval          interface status (MANDATORY: return 0 -> no Error)( U. S! [- i) W/ n- T: J
  7.   *
    . F6 y. k5 N0 a# x* V
  8.   */
    $ }$ N) `( C" W9 P
  9. uint8_t sths34pf80_algo_reset(uint8_t add)* U; w" @- m0 a& a
  10. {% U% P' h) x$ R1 Z- }! ?7 E$ W
  11.   uint8_t tmp;( }* t8 t" @7 B5 |+ [$ @1 |
  12.   int32_t ret;# M1 n: G0 T/ o3 H/ z3 O# l
  13. . ~2 j8 w! m3 L! d3 J$ ~
  14.   tmp = 1;$ y. R1 C+ K! N$ I- a* v3 v+ n, Y& @$ ?
  15.   ret = sths34pf80_func_cfg_write(add, STHS34PF80_RESET_ALGO, &tmp, 1);//STHS34PF80_RESET_ALGO->0x2A
    5 Q: @- A0 J* t+ I, c. |
  16. ! S, e% P& S4 @" }, x: I
  17.   return ret;4 {# y4 K; d( j* T+ Q
  18. }1 u7 z+ {7 V+ R1 {( t& m" x
复制代码
. z) Q: O. r+ g3 h0 j3 M4 r
该函数对RESET_ALGO (2Ah)的ALGO_ENABLE_RESET 置为位1,执行算法重置操作。默认情况下,这个位的值为 0,表示不进行算法重置。当用户修改了与算法相关的参数时(例如阈值、滞后等),需要将 ALGO_ENABLE_RESET 位设置为 1。重置完成后,ALGO_ENABLE_RESET 位应返回到默认值 0。& W0 Y" I9 [8 \
7 x9 z0 Y. O8 D) ?
10.png - b5 Y1 P, g% P  }+ _$ L

7 @! b8 K7 o& F, `  P8 }5 s/ L接着执行sths34pf80_tmos_odr_check_safe_set,将刚刚保存的ODR数据重新导入进入。
  1.   /* Set saved odr back */: E7 g8 s4 z; _2 ~4 s7 Z
  2.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
复制代码

+ Z% e" T% a  Y% }0 O到此,sths34pf80_presence_threshold_set函数就已经执行完毕。
# {" C: q4 P" l' Q5 S  P4 m  ?% `
! s1 o' V4 f/ N7 ]
设置存在滞后
0 B+ F, b" T  P/ Q这里使用的函数为sths34pf80_presence_hysteresis_set(STHS34PF80_ADDRESS, 20)。
  1. /**. n3 [- W/ i# ^: b# @
  2.   * @brief  Presence hysteresis.[set]
    / u$ D" j. a5 S, v4 W5 U$ B3 O8 ~
  3.   *+ N. W7 b* l' P$ t, r, L( Y4 ?9 b4 B
  4.   * @param  ctx      read / write interface definitions& q* X6 ~( r6 v- c& O1 {& ~; ~
  5.   * @param  val      Presence hysteresis value
    * f3 @: K# ^# T4 ?# G. e4 t
  6.   * @retval          interface status (MANDATORY: return 0 -> no Error)
    . ?- v+ m/ Q+ c+ W# b
  7.   *
    5 N9 N% D- ?7 u- [- K2 B) \
  8.   */
    / p. [' I' W" @
  9. uint8_t sths34pf80_presence_hysteresis_set(uint8_t add, uint8_t val)
    " }2 y# r5 p, Z) c8 X% ?
  10. {4 [% Z; G( m1 N2 x8 V
  11.   sths34pf80_ctrl1_t ctrl1;6 P  \7 ?* }3 P( h
  12.   uint8_t odr;; a: R. S8 X. q3 d3 `
  13.   int32_t ret;$ e& H2 g$ ~. M* O

  14. 7 z  u9 R9 r/ y! y# a! y
  15.   /* Save current odr and enter PD mode */$ q  w& z# |# @. D
  16.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);7 A7 Z' k1 b) {4 [  B7 }7 H8 Y
  17.   odr = ctrl1.odr;; a* |4 g/ l8 f$ ~$ F& M% e2 _
  18.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0);
    6 o5 V7 w' n. @3 n$ F
  19. 1 Q& u5 b+ ?$ W# h* J: c. e
  20.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_HYST_PRESENCE, &val, 1);
    : X" _6 x$ `, ?) J! I5 ^+ k2 e

  21. ( K8 W3 c0 u6 k7 Q
  22.   ret += sths34pf80_algo_reset(add);
    $ a1 D+ ?9 i* a5 Z9 Q3 p
  23. # H) Z- A  Y7 i. @) B/ j
  24.   /* Set saved odr back */
    ! P4 m; w; B( }" F' f6 ^! t" s
  25.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
    $ G1 q0 U4 H- Q% x7 f! g
  26. * w/ j  }' N1 A; k7 n  d- w
  27.   return ret;
    ) r2 X% Y' b0 e# z% r8 X
  28. }
复制代码

$ `" M  N/ T) B! k最开始读取CTRL1(20h)的数据,同时进行保存到odr变量中。
; f4 e# W$ `( b$ h' X# ?( \0 F
  1.   /* Save current odr and enter PD mode */
    1 {# _+ `( F3 Y0 |9 A( ]
  2.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x20. r5 e- Q: i8 Z! y: T  g, ?; w
  3.   odr = ctrl1.odr;, p4 e: _2 `3 q( X7 ?* d$ p
复制代码

# }4 c; y, L4 {& xret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0)这行代码用于在设置存在阈值之前,通过调用 sths34pf80_tmos_odr_check_safe_set 函数来确保在设置新的参数之前传感器的状态是稳定且安全的。
5 j4 H- S* ^0 k+ G+ y

3 h$ {3 l( B3 N6 T紧接着将传入的数据保存到val数组中,然后执行sths34pf80_func_cfg_write将val数据传入到HYST_PRESENCE (27h)中。2 e! U/ v1 F( t8 O4 S
  1.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_HYST_PRESENCE, &val, 1);
复制代码
3 ^( b0 y* R( N& j! U" A4 B; k5 y
这个滞后值有助于避免在边界值附近产生频繁的状态切换。! _1 }" y5 }* X6 Y
% ^* @* g3 P, Z, i4 Z' T  U
默认值: 预设的滞后值默认值是 32(0x32)。
% D6 X- B/ X4 d  |+ z5 u
4 ~( |& S+ B& j/ |! m& H
11.png
7 }3 O% ~" C8 k& e

3 ?; @0 _$ r( A例如,假设 PRESENCE_THS 设置为 200,而 HYST_PRESENCE 设置为 32。当测量值超过 200 时,传感器会认为存在某种状态。然后,要从存在状态切换到非存在状态,传感器必须降低测量值至少到达 200 - 32 = 168。只有当测量值降低到 168 以下时,传感器才会触发状态切换。" F. R/ z5 H# D1 q  X3 i
* _4 f+ U& M- m4 W
通过设置适当的滞后值,可以防止在测量值在阈值附近波动时出现不必要的状态切换,从而提高存在检测的稳定性。" s0 Z4 @5 ^4 D% n! o
* t" y1 e5 {" v7 }! o
接着执行sths34pf80_algo_reset函数,该函数主要对RESET_ALGO (2Ah)的ALGO_ENABLE_RESET 置为位1,执行算法重置操作。9 J9 J! D/ b/ C5 @" C; J0 V7 e
9 l; x# {! K& l6 J# U
  1. ret += sths34pf80_algo_reset(add);
复制代码
! U2 X4 `' ^5 g3 ^& M/ N
接着执行sths34pf80_tmos_odr_check_safe_set,将刚刚保存的ODR数据重新导入进入。
  1.   /* Set saved odr back */+ C3 p3 Z/ j' R  m- e$ O
  2.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
复制代码
* s# l7 ?; G1 Y; l! c
到此,sths34pf80_presence_hysteresis_set函数就已经执行完毕。# v2 O6 D- S, Q6 d
! H6 O% g1 Y/ b: {
# e0 x. a8 M% O4 M4 m
设置动作阈值
. i4 q; m4 D  G9 N5 s这里使用的函数为sths34pf80_motion_threshold_set(STHS34PF80_ADDRESS, 300)。
  1. /**% I+ ?6 T# T3 `; D, z3 m3 I
  2.   * @brief  Motion threshold.[set]
    + O1 z$ x0 Y+ o. Y
  3.   *
    ' C: B& H1 r1 ~! s4 I4 j0 n6 y& R
  4.   * @param  ctx      read / write interface definitions
    , H! V% e8 [) A8 t
  5.   * @param  val      motion threshold level1 Q. O* q; r9 C* }7 z9 ]( h2 @
  6.   * @retval          interface status (MANDATORY: return 0 -> no Error)' i8 o! p7 R9 A4 z! I
  7.   *& F% x% w2 C% T$ D9 L
  8.   */
    / o. m* y3 t7 d2 p% a) \7 O! k0 r
  9. uint8_t sths34pf80_motion_threshold_set(uint8_t add,  uint16_t val)8 y( t) ?8 M( c, q. H
  10. {4 `* ^- K$ K+ e3 T$ d4 C, |3 b
  11.   sths34pf80_ctrl1_t ctrl1;& v! g& _6 d$ g# e" p
  12.   uint8_t odr;4 B$ o; B& J1 q3 V$ P* z
  13.   uint8_t buff[2];% E& H* R9 _- y/ v1 q0 b
  14.   int32_t ret;
    " x/ T! X7 s6 \) q+ w; u. i- J

  15. 3 a# i0 o! F* \5 L+ x/ ^7 L
  16.   if ((val & 0x8000U) != 0x0U) {$ E. ]  j) {9 [8 h
  17.     /* threshold values are on 15 bits */
    2 P, s' ?- j+ k6 G- q( K. S- E
  18.     return -1;
    ( @/ m( f" x7 u
  19.   }, {' r4 e4 {! ], M7 O
  20. : d* b1 B. w, c, f
  21.   /* Save current odr and enter PD mode */$ d$ q; Z+ l8 W+ N, n# w
  22.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);2 r1 O1 J0 m( I2 }; G
  23.   odr = ctrl1.odr;
    % `1 X+ ~: `' w2 s3 D
  24.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0);
    1 h! j9 v( F9 ?8 f

  25. 3 L, B# X9 U  K/ H, f; t
  26.   buff[1] = (uint8_t)(val / 256U);1 \" c% y5 R$ E; P8 F
  27.   buff[0] = (uint8_t)(val - (buff[1] * 256U));: K) K: D# [7 f: s
  28.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_MOTION_THS, &buff[0], 2);
    ) B. s3 C* N5 w& c/ T/ F# }/ W

  29. 6 ?  v1 J" i  ^3 f
  30.   ret += sths34pf80_algo_reset(add);
    ( F; I1 ]7 L7 q
  31. 4 p& r5 ?. ^3 p0 T
  32.   /* Set saved odr back */
    , D; ]# `) f) z  H- I
  33.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);  L& W! d* M6 d+ l4 a3 v  n3 U5 |5 [
  34. 9 w0 z. l$ X$ q  D, k
  35.   return ret;
    " W" m/ z0 t+ M) ~
  36. }
复制代码
3 y0 C8 k9 m+ t1 n
最开始读取CTRL1(20h)的数据,同时进行保存到odr变量中。
  1.   /* Save current odr and enter PD mode */8 [! T. b7 D% h- F
  2.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);
    , v: T" h/ C9 C3 z% f# L
  3.   odr = ctrl1.odr;
    - k) U) d: }. w* y. v8 w6 a/ Q7 V. w
复制代码
9 _, c+ K5 G1 _
ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0)这行代码用于在设置存在阈值之前,通过调用 sths34pf80_tmos_odr_check_safe_set 函数来确保在设置新的参数之前传感器的状态是稳定且安全的。1 R" y  c# O+ W( a& ~! y
: Z/ P- X/ A8 n! q* n* H$ f
  1.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0);
复制代码
  Z, d7 N8 G* S2 \7 s: J
接着将传入的数据保存到buff数组中,然后执行sths34pf80_func_cfg_write将buff数据传入到MOTION_THS (22h - 23h)中。
  f; w& S& ^! p& x! Q
  1.   buff[1] = (uint8_t)(val / 256U);
    ) Q2 }/ l: @8 ]7 T, j/ h* H9 I
  2.   buff[0] = (uint8_t)(val - (buff[1] * 256U));
    0 o# y( p7 `4 d9 f- U7 R
  3.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_MOTION_THS, &buff[0], 2);* e) w+ r7 [  l
复制代码

# Q& j/ T( I! B0 YMOTION_THS 寄存器(地址范围为 0x22 到 0x23)用于设置运动检测算法的阈值。运动检测算法用于检测是否发生了物体的运动或动作。
1 z0 R! `$ `" |& C& y- a  h! o

% K2 j* }7 N1 a- d以下是这个寄存器的作用:( @: i% l" p; e

6 @9 @9 J! ?. \& k$ n' k运动阈值(Motion Threshold): 这是一个用于运动检测算法的阈值。阈值定义了在测量数据中,何时认为发生了物体的运动或动作。阈值是一个 15 位的无符号整数,其取值范围在 0 到 32767 之间。
& c; C0 a" Q1 ?9 ?0 ~2 F0 ?  T
& o3 I: m" `6 R2 ]& a! C
默认值: 预设的运动阈值默认值是 200(0x00C8)。7 I0 z; y9 `! j1 @9 m
) U  k. d6 {! y2 v5 C- N8 O7 |
例如,如果 MOTION_THS 设置为 300,这意味着当传感器测量的某个特定值超过了 300,传感器会认为发生了运动或动作状态。: ^. D# W5 H. ?% o& _* Y* C

6 j0 [0 A8 Q* r& n$ u通过设置适当的运动阈值,可以根据应用需求来调整运动检测的敏感度。更高的阈值会导致较大的变化才能被视为运动,而较低的阈值则会使传感器更敏感,甚至可能在较小的变化时触发运动检测。
! U2 l. Y$ o, P8 u4 }* m! t7 p( \, y, \) A6 M: L9 e4 C& U) R
12.png
8 T: I' g( h. W1 h( ]7 T, O8 Z7 z# B$ ?
接着执行sths34pf80_algo_reset函数,该函数主要对RESET_ALGO (2Ah)的ALGO_ENABLE_RESET 置为位1,执行算法重置操作。2 H& L/ R, L# L" x0 Y, S
: T% L: L" w- B' @! ]
  1. ret += sths34pf80_algo_reset(add);
复制代码
2 C" \7 H! W% P4 b0 x
接着执行sths34pf80_tmos_odr_check_safe_set,将刚刚保存的ODR数据重新导入进入。
  1.   /* Set saved odr back */" n' D7 v; o$ N" y) \- h2 h
  2.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
      G9 Q7 S. i+ J* J+ k
  3. " V% E1 t6 B5 J7 I, W8 w
复制代码
( K1 ~% B4 F3 A7 H8 a5 G, {" g
到此,sths34pf80_motion_threshold_set函数就已经执行完毕。5 B2 Q" X8 ^' c) P

# X3 C1 @: I' C% P' h7 W) x
7 H  [( M5 Y. R" l
设置动作滞后 9 e, X; ^3 [. Q5 W; F, x0 _1 b
这里使用的函数为sths34pf80_motion_hysteresis_set(STHS34PF80_ADDRESS, 30)。
  1. /**
    0 R  W& |# E8 O1 j+ r* u. e( X
  2.   * @brief  Motion hysteresis threshold.[set]6 q8 M# _6 \: X: p# \
  3.   *6 h! g4 {$ K2 x9 D
  4.   * @param  ctx      read / write interface definitions
    0 [) ?5 j( t, g. |; e1 C2 C! X
  5.   * @param  val      Motion hysteresis value) @% r4 {4 ~0 _, J
  6.   * @retval          interface status (MANDATORY: return 0 -> no Error)9 r0 m  w3 Y& H1 Z' T
  7.   *# b* p2 M9 ]! p: n4 c/ b) a
  8.   */
    / p* F( F8 |3 l  Z
  9. uint8_t sths34pf80_motion_hysteresis_set(uint8_t add, uint8_t val)3 C! B9 Y5 @7 M) T9 \
  10. {
    4 b' H& h' E6 k+ m: v
  11.   sths34pf80_ctrl1_t ctrl1;) z- S6 O% J# Q. ]5 `+ d, B! N
  12.   uint8_t odr;
    $ p/ h+ i2 I1 d3 w* p
  13.   int32_t ret;) P) m7 o% u) O* `+ p

  14. # \  x- b1 A- e. O  H
  15.   /* Save current odr and enter PD mode */
    + G  i2 n1 y8 O5 e' S6 U
  16.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);
    $ d4 U& [3 J- O, X5 y
  17.   odr = ctrl1.odr;! T* L& o0 W. ^, f* b
  18.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0);* ^7 Q; b, o+ @4 O( h  s, ~

  19. / z; e1 E2 h8 B" \( ]1 `" m5 u
  20.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_HYST_MOTION, &val, 1);
    $ b  k# [- b( o9 a8 z

  21. 6 R' |4 Z- `2 [: \) s
  22.   ret += sths34pf80_algo_reset(add);& K8 y6 J$ }6 X7 q! ?1 p" s
  23. , t& Q, K5 Y5 K6 z1 _( }* A
  24.   /* Set saved odr back */; H4 H7 _: S, Z
  25.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
      X) \& x4 n3 u

  26. ) g8 c9 y4 H8 G: o
  27.   return ret;1 U+ L, t0 a% s1 o, p) V) ^  x* i
  28. }
复制代码
* B' ~: L* s) n: _! H
最开始读取CTRL1(20h)的数据,同时进行保存到odr变量中。
  1.   /* Save current odr and enter PD mode */+ j0 {% u! `4 O
  2.   ret = sths34pf80_read_reg(add, STHS34PF80_CTRL1, (uint8_t *)&ctrl1, 1);//STHS34PF80_CTRL1->0x207 O. g5 R8 H( ]7 e4 x: u
  3.   odr = ctrl1.odr;
复制代码
+ [- J8 o) Z1 t) u% O+ m/ J: ]
ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, 0)这行代码用于在设置存在阈值之前,通过调用 sths34pf80_tmos_odr_check_safe_set 函数来确保在设置新的参数之前传感器的状态是稳定且安全的。
# K: }% J& @& s, p" k8 V5 ]2 _( N' U( D2 G4 A$ l0 l. t7 k
紧接着将传入的数据保存到val数组中,然后执行sths34pf80_func_cfg_write将val数据传入到HYST_MOTION (26h)中。
& Z5 M  N' s3 C) A1 u9 M) Z
! X  c; @0 r6 o4 }! O! a8 w! A
  1.   ret += sths34pf80_func_cfg_write(add, STHS34PF80_HYST_MOTION, &val, 1);
复制代码

7 U6 E# Z( u# j  r! }8 a# j$ U在运动检测算法中,滞后指的是当从运动状态切换到静止状态时,需要等待的时间或条件,以防止在短时间内频繁地切换状态。
5 r) a9 E- z2 F$ v$ N+ L6 S" X% m$ Z
5 v: A& k; Z* Q$ c! t% H9 ^默认值: 预设的滞后值默认值是 32(0x32)。
. ]7 }. L  I- B0 S- F+ w, ]! ?$ S; g* p0 y: ~5 S' @' k4 c
13.png 0 M! q! d7 I. U& g
; F" J# F# n7 B5 U5 A
例如,如果 MOTION_THS 设置为 300,而 HYST_MOTION 设置为 32。当测量值超过 300 时,传感器会认为发生了运动。然后,要从运动状态切换到非运动状态,传感器必须降低测量值至少到达 300 - 32 = 268。只有当测量值降低到 268 以下时,传感器才会触发状态切换。; \! ?4 m4 n$ p6 ]% O1 @% P
) h& S9 z# S/ b& Y
通过设置适当的运动滞后值,可以避免在测量值在运动状态附近波动时产生不必要的状态切换,从而提高运动检测的稳定性。这类似于存在检测中的概念,但针对的是运动状态。
" I+ m" \% G3 T, e5 B1 g7 W
. d& {: V. e" j+ C$ _0 q+ S6 ]* B
接着执行sths34pf80_algo_reset函数,该函数主要对RESET_ALGO (2Ah)的ALGO_ENABLE_RESET 置为位1,执行算法重置操作。+ ~8 i$ s$ N( c& [5 t9 j" q& [9 g
3 C/ Y3 P+ i$ X$ Y0 D4 x4 ?7 B
  1. ret += sths34pf80_algo_reset(add);
复制代码

3 E. s  y% p! _) w2 g/ F1 b接着执行sths34pf80_tmos_odr_check_safe_set,将刚刚保存的ODR数据重新导入进入。
  W0 |) r* o! x$ V$ e
  1.   /* Set saved odr back */" r9 F+ D; q! l0 l* k' G
  2.   ret += sths34pf80_tmos_odr_check_safe_set(add, ctrl1, odr);
    " m* h( u( N/ G* N( d
复制代码
; p6 L2 O$ p! U
到此,sths34pf80_motion_hysteresis_set函数就已经执行完毕。7 ^1 t$ t5 A; c' p2 [8 J7 E& L+ W
' [$ f, ]0 O- t5 z
主程序 2 h" d3 T- m8 ]6 I% f
初始化如下。
  1.   /* USER CODE BEGIN 2 */
    3 l) M/ n+ V$ F% q" \
  2.   sths34pf80_lpf_bandwidth_t lpf_m, lpf_p, lpf_p_m, lpf_a_t;  
    1 v  i0 @  h1 o1 v! e& ^$ I+ J
  3.   sths34pf80_tmos_drdy_status_t status;  - O  V: C/ Q( Q7 h4 w
  4.   sths34pf80_tmos_func_status_t func_status;   
    - N: v1 _! A' p1 [9 X# a* y$ J! O
  5.   7 a$ L0 |8 J9 u# }3 |3 I
  6.   HAL_Delay(200);  
    " _( F6 z6 {- j
  7.   printf("123");
    8 r) P! x" F8 w! g7 `9 _# ]
  8.   uint8_t STHS34PF80_ID =STHS34PF80_getChipID(STHS34PF80_ADDRESS);
    ( E) \$ i  @  l7 C2 E! `9 `
  9.   printf("STHS34PF80_ID=0x%x\n",STHS34PF80_ID);  5 O: b+ q' [2 d% _7 I  k' ^
  10.   if (STHS34PF80_ID != 0xD3)/ k; M: R' R' r& g' U6 [' R  B
  11.     while(1);; k( [4 g; F* U2 h/ m
  12. /* Set averages (AVG_TAMB = 8, AVG_TMOS = 32) */+ t, W% \+ C# l) c( ?
  13.   sths34pf80_avg_tobject_num_set(STHS34PF80_ADDRESS, STHS34PF80_AVG_TMOS_32);; \+ [( A3 U" \; O7 F" p6 M& @$ ~
  14.   sths34pf80_avg_tambient_num_set(STHS34PF80_ADDRESS, STHS34PF80_AVG_T_8);1 r" U5 @  H# R5 i. a) d% {
  15. ' G. R7 t: N" {
  16.   /* read filters */
    4 d+ W( {" N/ t) K0 N: v
  17.   sths34pf80_lpf_m_bandwidth_get(STHS34PF80_ADDRESS, &lpf_m);# r! @$ C- s; ?7 j5 t6 d$ L
  18.   sths34pf80_lpf_p_bandwidth_get(STHS34PF80_ADDRESS, &lpf_p);7 D( Q8 ^6 l% S1 N: I& V! F4 }
  19.   sths34pf80_lpf_p_m_bandwidth_get(STHS34PF80_ADDRESS, &lpf_p_m);
    4 Y3 k& S! B" }
  20.   sths34pf80_lpf_a_t_bandwidth_get(STHS34PF80_ADDRESS, &lpf_a_t);
    # @% y! ~- n0 `; F
  21. # Z2 {9 s/ {. k  V5 g- n
  22. printf("lpf_m: %02d, lpf_p: %02d, lpf_p_m: %02d, lpf_a_t: %02d\r\n", lpf_m, lpf_p, lpf_p_m, lpf_a_t);# |4 s/ c, X0 H
  23.   * @8 ^0 i% v' y! [# X5 H
  24.     /* Set BDU */: d  V& _  r9 i
  25.   sths34pf80_block_data_update_set(STHS34PF80_ADDRESS, 1);, h% P8 ^& f& E, z8 [
  26.   1 d, A- X) u8 m- s2 D( N5 L+ k
  27.   sths34pf80_presence_threshold_set(STHS34PF80_ADDRESS, 300);  //设置存在阈值。
    6 `7 t9 U& g' m5 B7 m8 D9 B
  28.   sths34pf80_presence_hysteresis_set(STHS34PF80_ADDRESS, 20);//“存在滞后”(Presence Hysteresis)的函数. D! d  }% J& ]9 S
  29.   sths34pf80_motion_threshold_set(STHS34PF80_ADDRESS, 300);//设置动作阈值/ c" S3 F5 w5 F; }9 k% C6 P& ?
  30.   sths34pf80_motion_hysteresis_set(STHS34PF80_ADDRESS, 30);  动作滞后”(Motion Hysteresis)的函数
    , G) j  e  |8 r6 a+ U; m4 g  x& @
  31.   /* Set ODR */
    $ K- X! l' }& V: ]$ N$ @
  32.   sths34pf80_tmos_odr_set(STHS34PF80_ADDRESS, STHS34PF80_TMOS_ODR_AT_30Hz);
    : D; }# N$ l1 A: Q/ W7 t

  33. + J, d6 a( s* B& I7 g6 b0 x- k' ?
  34.     int32_t cnt = 0;, r9 k0 K) N$ B' [" K! z0 c5 G* y0 ^
  35.   9 x7 ?* M; i/ N
  36.   /* USER CODE END 2 */
复制代码
4 Z" G, {1 t% j
main函数如下所示。
  1.   /* Infinite loop */8 a' {  N) q1 A6 \4 f
  2.   /* USER CODE BEGIN WHILE */7 F& ^) d2 H( L5 @- T. P
  3.   while (1)4 J% s9 ^# Z& w
  4.   {( W. W7 T) J0 y/ l/ v, a
  5.     sths34pf80_tmos_drdy_status_get(STHS34PF80_ADDRESS, &status);
    # c, J# `% n. D; y6 }
  6.     if (status.drdy)
    ) u+ a% y" _# T& q1 ]+ X" L
  7.     {
    1 P* Z6 c4 U9 ^" ^) {- I
  8.       sths34pf80_tmos_func_status_get(STHS34PF80_ADDRESS, &func_status);
    ) a# T. g% E. R7 N1 a; M/ ^) A
  9.       printf("-->环境温度冲击检测标志位 %d - 存在检测标志位 %d - 运动检测标志位 %d\r\n",func_status.tamb_shock_flag, func_status.pres_flag, func_status.mot_flag);6 U. H7 Y( w1 `9 k
  10.    }
    , V' A( B+ |; v# y5 k
  11.       HAL_Delay(1000);
    / Q5 {; \1 Z- l/ ?+ \: `; u! V

  12. 5 W! D& ~( S3 x- e' S1 D) A3 w
  13.     /* USER CODE END WHILE */& f$ v: `4 n# \/ i! g! g
  14. 2 {. z3 k+ d6 W3 B- ~
  15.     /* USER CODE BEGIN 3 */2 F! [4 l3 A6 B# M' T7 s
  16.   }% b0 p: _& ?8 Z0 T5 M' l/ [3 Y
  17.   /* USER CODE END 3 */
    5 y; X6 z2 ?2 ~- b& Y( M, Y
复制代码
$ R+ Q! O* V4 m& U; E
9 c5 Z' p& [- l# V  ~
转载自:记帖
1 m* A2 \$ ]( F如有侵权请联系删除
- _4 V' M3 @. j
4 V; E( g% _' L) J# u9 s: i: ^; E0 ], I% [3 \0 v: P5 E

! R6 V. d, R' \. G' U* P( ]8 r  Y8 x; Y) }) m4 w! U

8 J$ k/ {0 m% B
赞 收藏 评论0 发布时间:2023-11-16 17:09

举报

0个回答

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版