阅读说明：本技术 一种牙齿清洁方法及系统 (Tooth cleaning method and system ) 是由 周游 于 2019-09-11 设计创作，主要内容包括：本发明公开一种牙齿清洁方法及系统,所述方法包括获取牙刷在口腔内的加速度和角速度；根据所述牙刷在口腔内的加速度和角速度确定牙刷在口腔内的位置；根据所述牙刷在口腔内的位置,确定牙刷在口腔内的轨迹；根据所述牙刷在口腔内的轨迹,确定刷牙方案；根据所述牙刷方案清洁牙齿。本发明所提供的一种牙齿清洁方法及系统,实现口腔的全面清洁。(The invention discloses a tooth cleaning method and a tooth cleaning system, wherein the method comprises the steps of obtaining the acceleration and the angular speed of a toothbrush in an oral cavity; determining the position of the toothbrush in the oral cavity according to the acceleration and the angular speed of the toothbrush in the oral cavity; determining the track of the toothbrush in the oral cavity according to the position of the toothbrush in the oral cavity; determining a brushing regimen based on the trajectory of the toothbrush within the oral cavity; cleaning teeth according to the toothbrush regimen. The tooth cleaning method and the tooth cleaning system provided by the invention can realize the comprehensive cleaning of the oral cavity.)

1. a method of cleaning teeth, comprising:

Acquiring acceleration and angular speed of the toothbrush in the oral cavity;

determining the position of the toothbrush in the oral cavity according to the acceleration and the angular speed of the toothbrush in the oral cavity;

Determining the track of the toothbrush in the oral cavity according to the position of the toothbrush in the oral cavity;

determining a brushing regimen based on the trajectory of the toothbrush within the oral cavity;

cleaning teeth according to the toothbrush regimen.

2. A tooth-cleaning method as claimed in claim 1, wherein said determining the position of the toothbrush in the oral cavity based on the acceleration and angular velocity of said toothbrush in the oral cavity comprises:

determining a quaternion according to the acceleration and the angular velocity;

Determining an Euler angle according to the quaternion;

and determining the position of the toothbrush in the oral cavity according to the Euler angle.

3. A tooth-cleaning method as claimed in claim 1, wherein said obtaining the acceleration and the acceleration of the toothbrush in the oral cavity comprises:

the acceleration of 3 shafts and the angular speed of 3 shafts of the toothbrush in the oral cavity are obtained by utilizing a six-shaft sensor arranged on a chip inside the toothbrush head.

4. a tooth-cleaning method as claimed in claim 2, characterized in that before determining the quaternion from said acceleration and said angular velocity, it further comprises:

And sending the acceleration and the angular speed to a client by utilizing a Bluetooth device arranged on a toothbrush.

5. A tooth-cleaning method as claimed in claim 2, characterized in that said determining a quaternion from said acceleration and said angular velocity comprises:

And performing integrated operation on the acquired acceleration and the acceleration of the toothbrush in the oral cavity to determine a quaternion.

6. A tooth-cleaning method as claimed in claim 2, characterized in that said determining the euler angles from said quaternion comprises:

performing calculus processing on the quaternion to determine the quaternion subjected to calculus processing;

And carrying out mean value filtering processing on the quaternion processed by the calculus to determine the Euler angle.

7. a tooth cleaning system, comprising:

The speed acquisition module is used for acquiring the acceleration and the angular speed of the toothbrush in the oral cavity;

the toothbrush position determining module is used for determining the position of the toothbrush in the oral cavity according to the acceleration and the angular speed of the toothbrush in the oral cavity;

the track determining module is used for determining the track of the toothbrush in the oral cavity according to the position of the toothbrush in the oral cavity;

The tooth brushing scheme determining module is used for determining a tooth brushing scheme according to the track of the toothbrush in the oral cavity;

A cleaning module for cleaning teeth according to the toothbrush regimen.

8. A tooth-cleaning system as claimed in claim 7, characterized in that said toothbrush position determination module comprises:

A quaternion determining unit for determining a quaternion from the acceleration and the angular velocity;

An Euler angle determining unit for determining an Euler angle according to the quaternion;

And the toothbrush position determining unit is used for determining the position of the toothbrush in the oral cavity according to the Euler angle.

9. a tooth-cleaning system as claimed in claim 7, characterized in that said speed acquisition module comprises:

And the speed acquisition unit is used for acquiring 3-axis acceleration and 3-axis acceleration of the toothbrush in the oral cavity by using a six-axis sensor arranged on the toothbrush chip.

10. a tooth-cleaning system as claimed in claim 8, characterized in that it further comprises:

and the data sending module is used for sending the acceleration and the angular velocity to a client by utilizing a Bluetooth device arranged on the toothbrush.

Technical Field

The invention relates to the field of oral monitoring, in particular to a tooth cleaning method and a tooth cleaning system.

background

with the improvement of the quality of life, people can eat various foods, and different food residues bring various oral problems. Oral problems now afflict people of different ages. Based on the above problems, in order to reduce the trouble caused by the oral problems, people update the traditional toothbrush to the intelligent toothbrush, and reduce food residues as much as possible through the intelligent toothbrush. However, people only brush teeth to clean according to their own use habits, but it is unclear whether the intelligent toothbrush cleans each tooth in the oral cavity, that is, the position of the intelligent toothbrush in the oral cavity is unclear, and thus the oral cavity cannot be cleaned comprehensively, and the tooth cleaning effect is poor.

Disclosure of Invention

the invention aims to provide a tooth cleaning method and a tooth cleaning system, which solve the problem of poor cleaning effect of a toothbrush in the prior art.

In order to achieve the purpose, the invention provides the following scheme:

A method of tooth cleaning comprising:

acquiring acceleration and angular speed of the toothbrush in the oral cavity;

determining the position of the toothbrush in the oral cavity according to the acceleration and the angular speed of the toothbrush in the oral cavity;

determining the track of the toothbrush in the oral cavity according to the position of the toothbrush in the oral cavity;

determining a brushing regimen based on the trajectory of the toothbrush within the oral cavity;

Cleaning teeth according to the toothbrush regimen.

optionally, the determining the position of the toothbrush in the oral cavity according to the acceleration and the angular velocity of the toothbrush in the oral cavity specifically includes:

determining a quaternion according to the acceleration and the angular velocity;

determining an Euler angle according to the quaternion;

And determining the position of the toothbrush in the oral cavity according to the Euler angle.

Optionally, the acquiring acceleration and acceleration of the toothbrush in the oral cavity specifically includes:

the acceleration of 3 shafts and the angular speed of 3 shafts of the toothbrush in the oral cavity are obtained by utilizing a six-shaft sensor arranged on a chip inside the toothbrush head.

optionally, before determining the quaternion according to the acceleration and the angular velocity, the method further includes:

And sending the acceleration and the angular speed to a client by utilizing a Bluetooth device arranged on a toothbrush.

optionally, the determining a quaternion according to the acceleration and the angular velocity specifically includes:

And performing integrated operation on the acquired acceleration and the acceleration of the toothbrush in the oral cavity to determine a quaternion.

optionally, the determining an euler angle according to the quaternion specifically includes:

Performing calculus processing on the quaternion to determine the quaternion subjected to calculus processing;

And carrying out mean value filtering processing on the quaternion processed by the calculus to determine the Euler angle.

A tooth cleaning system comprising:

the speed acquisition module is used for acquiring the acceleration and the angular speed of the toothbrush in the oral cavity;

The toothbrush position determining module is used for determining the position of the toothbrush in the oral cavity according to the acceleration and the angular speed of the toothbrush in the oral cavity;

the track determining module is used for determining the track of the toothbrush in the oral cavity according to the position of the toothbrush in the oral cavity;

the tooth brushing scheme determining module is used for determining a tooth brushing scheme according to the track of the toothbrush in the oral cavity;

A cleaning module for cleaning teeth according to the toothbrush regimen.

Optionally, the toothbrush position determining module specifically includes:

A quaternion determining unit for determining a quaternion from the acceleration and the angular velocity;

an Euler angle determining unit for determining an Euler angle according to the quaternion;

And the toothbrush position determining unit is used for determining the position of the toothbrush in the oral cavity according to the Euler angle.

optionally, the speed obtaining module specifically includes:

And the speed acquisition unit is used for acquiring 3-axis acceleration and 3-axis acceleration of the toothbrush in the oral cavity by using a six-axis sensor arranged on the toothbrush chip.

Optionally, the method further includes:

And the data sending module is used for sending the acceleration and the angular velocity to a client by utilizing a Bluetooth device arranged on the toothbrush.

According to the specific embodiment provided by the invention, the invention discloses the following technical effects: according to the tooth cleaning method and the tooth cleaning system, the position of the toothbrush in the oral cavity is determined through the acceleration and the angular speed of the toothbrush in the oral cavity, namely, the state of the toothbrush in the oral cavity of a human body is accurately obtained, the current tooth brushing part of the toothbrush is accurately known, the track of the toothbrush in the oral cavity is known through the position of the toothbrush in the oral cavity, the whole tooth brushing process of the toothbrush can be clearly known, the cleaning condition of each tooth can be known, in addition, the tooth brushing scheme is formulated through the track of the toothbrush in the oral cavity, the teeth are cleaned according to the tooth brushing scheme, and the comprehensive cleaning of the oral cavity is further realized.

Drawings

In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings needed to be used in the embodiments will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings without inventive exercise.

FIG. 1 is a schematic flow chart of a method of tooth cleaning according to the present invention;

Fig. 2 is a schematic view of a tooth cleaning system according to the present invention.

Detailed Description

the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.

the invention aims to provide a tooth cleaning method and a tooth cleaning system, which solve the problem of low cleaning strength of toothbrushes in the prior art.

In order to make the aforementioned objects, features and advantages of the present invention comprehensible, embodiments accompanied with figures are described in further detail below.

Fig. 1 is a schematic flow chart of a tooth cleaning method according to the present invention, as shown in fig. 1, a tooth cleaning method includes:

S101, acquiring acceleration and angular speed of the toothbrush in the oral cavity;

S102, determining the position of the toothbrush in the oral cavity according to the acceleration and the angular speed of the toothbrush in the oral cavity;

s103, determining the track of the toothbrush in the oral cavity according to the position of the toothbrush in the oral cavity;

s104, determining a tooth brushing scheme according to the track of the toothbrush in the oral cavity;

s105, cleaning teeth according to the toothbrush scheme.

in practical application, the determining the position of the toothbrush in the oral cavity according to the acceleration and the angular velocity of the toothbrush in the oral cavity specifically comprises:

Determining a quaternion according to the acceleration and the angular velocity;

Determining an Euler angle according to the quaternion;

And determining the position of the toothbrush in the oral cavity according to the Euler angle.

the method for acquiring the acceleration and the acceleration of the toothbrush in the oral cavity specifically comprises the following steps:

The acceleration of 3 shafts and the angular speed of 3 shafts of the toothbrush in the oral cavity are obtained by utilizing a six-shaft sensor arranged on a chip inside the toothbrush head.

before determining the quaternion according to the acceleration and the angular velocity, the method for visualizing the real-time position of the toothbrush further comprises:

and sending the acceleration and the angular speed to a client by utilizing a Bluetooth device arranged on a toothbrush.

in a specific embodiment, the determining a quaternion according to the acceleration and the angular velocity specifically includes:

And performing integrated operation on the acquired acceleration and the acceleration of the toothbrush in the oral cavity to determine a quaternion.

Determining an euler angle according to the quaternion specifically comprises:

Performing calculus processing on the quaternion to determine the quaternion subjected to calculus processing;

And carrying out mean value filtering processing on the quaternion processed by the calculus to determine the Euler angle.

in a specific application, the tooth cleaning method provided by the invention selects a measurement reference point O coordinate center (namely, a toothbrush position in the oral cavity) on a measured object, constructs a three-dimensional coordinate system O-XYZ, sets six directions X positive direction, X negative direction, Y positive direction, Y negative direction, Z positive direction and Z negative direction along a coordinate axis as reference directions, and specifically comprises the following steps:

a six-axis sensor is arranged in a toothbrush head and respectively acquires the acceleration of 3 axes and the angular velocity of 3 axes of the toothbrush in the oral cavity; the read three-axis acceleration 16 scale is respectively: acc _ x _ h, acc _ x _ l, acc _ y _ h, acc _ y _ l, acc _ z _ h and acc _ z _ l;

acc _ x _ h is positive acceleration of the x axis; acc _ x _ l is the acceleration of the negative direction of the x axis; the acc _ y _ h is positive acceleration of the y axis; acc _ y _ l is the acceleration of the y axis in the negative direction; the acc _ z _ h is the positive direction acceleration of the z axis; acc _ z _ l is z-axis negative direction acceleration.

the angular velocities of the three axes read are: gyro _ x _ h, gyro _ x _ l, gyro _ y _ h, gyro _ y _ l, gyro _ z _ h, and gyro _ z _ l.

gyrox _ h is the positive direction angular speed of the x axis; gyro _ x _ l is the x-axis negative direction angular velocity; gyro _ y _ h is the positive y-axis angular velocity; gyro _ y _ l is the negative direction angular velocity of the y axis; gyro _ z _ h is the positive z-axis angular velocity; gyro _ z _ l is positive and negative z-axis angular velocity.

and transmitting the obtained acceleration of the 3 shafts and the angular speed of the 3 shafts to an algorithm module of the client through a Bluetooth module in the toothbrush.

and performing integrated operation on the obtained acceleration of the 3 axes and the angular velocity of the 3 axes to obtain a quaternion:

the specific integration steps are as follows:

Combining the acceleration of the x, y and z axes respectively by using a formula 1;

Acc_x＝(acc_x_h*256)+acc_x_l

Acc _ y ═ (Acc _ y _ h × 256) + Acc _ y _ l formula 1

Acc_z＝(acc_z_h*256)+acc_z_l

Combining the angular velocities of the x, y and z axes respectively by using a formula 2;

gyro_x＝(gyro_x_h*256)+gyro_x_l

gyro _ y ═ gyro _ y _ h × 256) + gyro _ y _ l formula 2:

gyro_z＝(gyro_z_h*256)+gyro_z_l

performing calculus processing on the quaternion; the processing steps are as follows:

Let norm (acceleration of gravity) be (Acc _ x + Acc _ y + Acc _ z) square-off

Setting:

ax＝Acc_x/norm；

ay＝Acc_y/norm；

az＝Acc_z/norm；

ax is the gravity acceleration in the x-axis direction, ay is the gravity acceleration in the y-axis direction, and az is the gravity acceleration in the z-axis direction.

Let q0, q1, q2, q3 be quaternions, which are related as follows:

q0q0＝q0*q0；

q0q1＝q0*q1；

q0q2＝q0*q2；

q0q3＝q0*q3；

q1q1＝q1*q1；

q1q2＝q1*q2；

q1q3＝q1*q3；

q2q2＝q2*q2；

q2q3＝q2*q3；

q3q3＝q3*q3；

extracting gravity components in an equivalent cosine matrix of the quaternion from the quaternion;

vx＝2*(q1q3-q0q2)；

vy＝2*(q0q1+q2q3)；

vz＝1-2*(q1*q1+q2*q2)；

vx is the gravity component in the x-axis direction equivalent cosine matrix, vy is the gravity component in the y-axis direction equivalent cosine matrix, vz is the gravity component in the z-axis direction equivalent cosine matrix.

obtaining attitude error by using vector cross product

ex＝(ay*vz-az*vy)；

ey＝(az*vx-ax*vz)；

ez＝(ax*vy-ay*vx)；

ex is the x-axis attitude error, ey is the y-axis attitude error, and ez is the z-axis attitude error.

integrating the three-axis attitude error;

Let ki be 0.001 error integral gain (offset value of gyroscope)

exInt＝ex*ki；

eyInt＝ey*ki；

ezInt＝ez*ki；

exInt is an x-axis direction error integral value, eyInt is a y-axis direction error integral value, and ezInt is a z-axis direction error integral value.

carrying out mean value filtering processing on the quaternion subjected to calculus processing to determine the Euler angle; the specific treatment steps are as follows:

compensating attitude error to angular velocity using complementary filtering, correcting angular velocity integral drift

setting kp2.0f acceleration weight, wherein the larger the acceleration weight is, the faster the acceleration weight is converged to the measured value of the acceleration;

gx + ═ kp ex + exInt; (post-compensating the error PI to the gyroscope, i.e., compensating for zero drift);

gy + ═ kpey + eyInt; (correction of gyro output);

gz + ═ kp + ezInt; (where gz, because it is not corrected by the observer, drifts, showing either an integral self-increase or self-decrease);

Updating the quaternion by using a first-order Runge Kutta method;

q0+ (-q1 × gx-q2 × gy-q3 × gz) × 0.5 × deltaT; delatT is the transmission rate;

q1+＝(q0*gx+q2*gz-q3*gy)*0.5*deltaT；

q2+＝(q0*gy-q1*gz+q3*gx)*0.5*deltaT；

q3+＝(q0*gz+q1*gy-q2*gx)*0.5*deltaT；

Quaternion normalization;

norm＝sqrt(q0*q0+q1*q1+q2*q2+q3*q3)；

q0＝q0/norm；

q1＝q1/norm；

q2＝q2/norm；

q3＝q3/norm；

Converting quaternion into Euler angle;

let RAD _ TO _ DEG equal TO 1/pi;

GyroAngle.z＝tan2(2.0f*(q1*q2-q0*q3)，2.0f*(q1q1+q2q2)-1)*RAD_TO_ DEG；//YAW；

GyroAngle.x＝sin(-2*q1*q3+2*q0*q2)*RAD_TO_DEG；//pitch；

GyroAngle.y＝tan2(2*q2*q3+2*q0*q1，-2*q1*q1-2*q2*q+1)*RAD_TO_DEG；// roll。

The position of the toothbrush can be known in real time in the client according to the determined Euler angle.

in a specific embodiment, a user uploads a self oral cavity three-dimensional graph to a client in advance, the client maps the real-time position of the toothbrush to the oral cavity three-dimensional graph, the user can accurately know the specific position of the toothbrush in the oral cavity, the track of the toothbrush in the oral cavity is drawn according to the real-time position, the user can clearly know the tooth brushing process, the client stores and transmits data to a cloud server for storage, the data of one week is counted and returned to the client, and the client displays the data in a graphical mode to know the specific condition of each tooth.

The tooth cleaning method provided by the invention has the advantages that the six-axis sensor is utilized to obtain the acceleration and the angular speed of 3 axes; and the acceleration and the angular velocity of the 3 axes are subjected to gravity acceleration normalization processing.

and extracting gravity components in the equivalent cosine matrix of the quaternion.

And carrying out vector cross product calculation on the acceleration of the 3 axes after the acceleration normalization processing and the extracted gravity component to obtain an attitude error.

and performing integral calculation on the attitude error.

and performing complementary filtering, compensating the attitude error after integral calculation to the angular velocity, and correcting the integral deviation of the angular velocity.

And updating the quaternion by using a first-order Runge Kutta method, and normalizing the updated quaternion.

and determining the euler angle by using the quaternion after the normalization processing.

The technical scheme of the invention can monitor the position change method of the toothbrush in the oral cavity at any time so as to enable people to observe the conditions of the oral cavity and the teeth more clearly and intuitively, the algorithm adopts the six-axis module and the Bluetooth data transmission, can more accurately represent the current position of the toothbrush in the oral cavity of the human body, the acceleration of 3 axes and the angular velocity of 3 axes are obtained in the six-axis sensor, respectively, and after taking the data of 6 axes respectively, integrating and operating to obtain quaternion, carrying out calculus processing on the quaternion, and then filtering by mean value (filtering interference fluctuation of each gear of the toothbrush) to obtain accurate data of each translation and rotation position of the toothbrush, wherein the algorithm is used in the development of a mobile terminal, the graphical mode can make people know that a certain position is brushed at present more intuitively, and a better brushing scheme can be made for the users according to the brushing habits of the users.

aiming at the technical problems (space efficiency, high error rate and low reaction speed) of the prior art, the algorithm utilizes six axes and starts a Bluetooth 4.0 transmission technology (the speed of receiving and transmitting 15 bytes every 50 ms), and the algorithm is used for processing the acceleration of the three axes x, y and z and the angular velocity of the three axes, so that the algorithm is applied to the development of a mobile terminal, a user can brush teeth more intuitively and clearly in a graphical mode, and the condition of brushing teeth of the user for a long time can be shown.

the client and corresponding app may provide a graphical interface in which changes in the status of different positions of the toothbrush may be made. Further enabling the monitoring of the state change and position of the 3d physical model inside the space.

fig. 2 is a tooth cleaning system provided by the present invention, as shown in fig. 2, a tooth cleaning system comprising: a speed acquisition module 201, a toothbrush position determination module 202, a trajectory determination module 203, a brushing regimen determination module 204, and a cleaning module 205.

The speed acquisition module 201 is used for acquiring acceleration and angular speed of the toothbrush in the oral cavity.

The toothbrush position determination module 202 is used for determining the position of the toothbrush in the oral cavity according to the acceleration and the angular velocity of the toothbrush in the oral cavity.

The track determining module 203 is used for determining the track of the toothbrush in the oral cavity according to the position of the toothbrush in the oral cavity.

the brushing regimen determination module 204 is configured to determine a brushing regimen based on the trajectory of the toothbrush within the oral cavity.

cleaning module 205 is used to clean teeth according to the toothbrush regimen.

the toothbrush position determination module 202 specifically includes: a quaternion determining unit, an Euler angle determining unit, and a toothbrush position determining unit.

And the quaternion determining unit is used for determining a quaternion according to the acceleration and the angular velocity.

and the Euler angle determining unit is used for determining the Euler angle according to the quaternion.

The toothbrush position determining unit is used for determining the position of the toothbrush in the oral cavity according to the Euler angle.

the speed obtaining module 201 specifically includes: a speed acquisition unit.

The speed acquisition unit is used for acquiring 3-axis acceleration and 3-axis acceleration of the toothbrush in the oral cavity by using a six-axis sensor arranged on the toothbrush chip.

The present invention provides a tooth cleaning system further comprising: and a data sending module.

The data sending module is used for sending the acceleration and the angular velocity to a client by using a Bluetooth device arranged on the toothbrush.

the embodiments in the present description are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. For the system disclosed by the embodiment, the description is relatively simple because the system corresponds to the method disclosed by the embodiment, and the relevant points can be referred to the method part for description.

The principles and embodiments of the present invention have been described herein using specific examples, which are provided only to help understand the method and the core concept of the present invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, the specific embodiments and the application range may be changed. In view of the above, the present disclosure should not be construed as limiting the invention.