A laser tracking balance car control circuit

By designing a control circuit integrating six-axis motion processing module, Bluetooth module, motor drive module and voltage stabilization module in the laser tracking balance bike, the problem that the balance bike cannot maintain balance when it is stationary is solved, and both movement and static are achieved The function that can maintain balance enhances intelligence and learning.

CN110764524BActive Publication Date: 2024-11-26GUANGZHOU CITY UNIV OF TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN201911288252.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2019-12-16
Publication Date
2024-11-26
Estimated Expiration
2039-12-16

AI Technical Summary

Technical Problem

Existing laser tracking balance bikes can maintain balance when they are moving, but cannot maintain balance when they are still, and lack intelligence and learning.

Method used

A control circuit including a six-axis motion processing module, a Bluetooth module, a motor drive module, a microcontroller chip and a voltage stabilization module is designed. The microcontroller chip receives the control instructions of the Bluetooth module, sends control instructions to the motor drive module, and adjusts the wind. The wheels and speed control the parameters of the motor to achieve balance in both movement and rest.

Benefits of technology

It realizes the integration of wireless control and infrared tracking functions. The circuit structure is simple. It can adjust parameters and maintain balance when it is stationary by the wind turbine motor, and maintain balance by speed control during movement, which enhances the intelligence and learning of the balance bike.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN110764524B_ABST
    Figure CN110764524B_ABST
Patent Text Reader

Abstract

The invention discloses a laser tracking balance car control circuit, comprising a six-axis motion processing module, a Bluetooth module, a motor drive module, a micro-control chip, a voltage stabilizing module and a visual module. The PB8, PB9 and PB52 terminals of the micro-control chip are connected to the six-axis motion processing module wires, the PB10 and PB11 terminals of the micro-control chip are connected to the Bluetooth module wires, the PB12PB9, PB13PB8, PB14PB6, PB15PB13, PA8B14, PB15, PA7, PA8 and PA121 terminals of the micro-control chip are connected to the DC motor drive module wires, the micro-control chip comprises a clock circuit and a reset circuit and a filtering and stabilizing current circuit connected thereto. The invention integrates wireless control, infrared tracking and balancing operation functions, adds an infrared laser tracking function on the basis of balancing operation, so that the balance car is no longer a single function of balancing operation, allows children to be exposed to artificial intelligence, and allows children to play and learn at the same time, so as to achieve both learning and entertainment.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a control circuit, in particular to a laser tracking balance vehicle control circuit, and belongs to the technical field of laser tracking balance vehicles. Background Art

[0002] Social progress means the improvement of people's living standards, and the proportion of entertainment and learning is increasing. In particular, children can learn a lot while having fun. This is an expectation of modern people and a problem in contemporary society. It is also the development trend of children's toys in the future. Based on realistic considerations, it is found that children have a unique interest in electronic products. In order to increase children's enthusiasm for learning, parents, teachers and educators from all walks of life have proposed many solutions, but they have not been well resolved so far. One of the reasons is that mobile phones are too tempting for children. In order to keep children away from mobile phones, computers and other electronic consumer products.

[0003] The laser tracking car is a favorite toy for children. It can exercise the body and intelligence and increase the interaction between parents and children. However, the laser tracking car in the existing technology is not smart enough and blindly pursues commercialization and entertainment, which makes it not very learnable. For this reason, we designed a laser tracking balance car control circuit to provide the intelligence and learnability of the laser tracking balance car in the existing technology. The existing balance car generally maintains balance when moving, and cannot maintain balance when stationary. Summary of the invention

[0004] The main purpose of the present invention is to provide a laser tracking balance car control circuit, which can be wirelessly controlled and can maintain a balanced state when the balance car is in motion or stationary, and has a simple circuit structure.

[0005] The purpose of the present invention can be achieved by adopting the following technical solutions:

[0006] A laser tracking balance car control circuit comprises a six-axis motion processing module, a Bluetooth module, a motor drive module, a microcontroller chip, a voltage stabilizing module and a visual module, wherein the PB8, PB9 and PB52 terminals of the microcontroller chip are connected to the six-axis motion processing module wires, the PB10 and PB11 terminals of the microcontroller chip are connected to the Bluetooth module wires, the PB12, PB9, PB13, PB8, PB14, PB6, PB15, PB13, PA8, PB15, PA7, PA8 and PA121 terminals of the microcontroller chip are connected to the motor drive module wires, the microcontroller chip comprises a clock circuit and a reset circuit connected thereto and a filtering and stabilizing current circuit, wherein the OSC_INPD0 and OSC_OUTPD1 terminals of the microcontroller chip are connected to the clock circuit wires, and the VSSA, VSS_2, VSS_1, The VSS_3 terminal is grounded, the VDDA, VDD_2, VDD_1, and VDD_3 terminals of the microcontroller chip are externally connected to a voltage regulator module and connected to the wire of the filter and current stabilizing circuit, and the NRST terminal of the microcontroller chip is connected to the wire of the reset circuit. The motor drive module includes a motor drive control unit and an interface P4 and an interface P5. The motor drive control unit includes a chip U3, the 1 and 2 terminals of the chip U3 are connected, the 3 and 4 terminals of the chip U3 are connected and grounded, the 5 and 6 terminals of the chip U3 are connected, the 7 and 8 terminals of the chip U3 are connected, the 9 and 10 terminals of the chip U3 are connected and grounded, the 11 and 12 terminals of the chip U3 are connected, and the 15, 16, 17, 21, 22, and 23 terminals of the chip U3 are connected to the PB6 of the microcontroller chip. , PB13, PB14, PB15, PA8, and PA7 are connected respectively, the 19 and 20 terminals of the chip U3 are connected and connected to the voltage stabilizing circuit, the 13 and 14 terminals of the chip U3 are connected to the VS terminal of the interface P4 and the VS terminal of the interface P5 respectively, the GND terminal of the interface P4 is grounded, the IN and INH terminals of the interface P4 are connected to one end of the resistors R5 and R7 respectively, the other ends of the resistors R5 and R7 are connected to the ATN1 and AEN terminals of the chip U1 respectively, the OUT terminal of the interface P4 is connected to the speed control motor, the SR and IS terminals of the interface P4 are connected to one end of the resistor R9 and the resistor R11 respectively, and the other ends of the resistors R9 and R11 are grounded, and the GND terminal of the interface P4 is grounded;

[0007] The IN and INH terminals of the interface P5 are connected to one end of the resistors R6 and R8 respectively, the other ends of the resistors R6 and R8 are connected to the ATN2 and AEN terminals of the chip U1 respectively, the OUT terminal of the interface P5 is connected to the wind wheel control motor, the SR and IS terminals of the interface P5 are connected to one end of the resistor R10 and the resistor R12 respectively, and the other ends of the resistors R10 and R12 are grounded;

[0008] The 1A1, 1A2, 1A3 terminals of the chip U1 are connected to the PB9, PB8 and PA12 of the microcontroller chip respectively, and the 1A3 terminal of the chip U1 is grounded through the resistor R1, the 1Y1, 1Y2, 1Y3 of the chip U1 are connected to the chip U3, and the ground terminal of the chip U1 is grounded;

[0009] The microcontroller chip is used to store programs and receive control instructions sent by the Bluetooth module, and send control instructions to the motor drive module. When the balancing vehicle is moving, the speed control motor adjusts the parameters to ensure that the balancing vehicle maintains a balanced state and maintains a balanced state according to the movement trajectory;

[0010] The motor drive module is used to receive control instructions sent by the microcontroller chip, and send control instructions to the speed control motor and the wind wheel motor, so that the wind wheel motor and the speed control motor are adjusted according to the adjustment parameters sent by the single chip microcomputer.

[0011] Preferably, the six-axis motion processing module includes a six-axis motion processing chip, the 23 and 24 terminals of the six-axis motion processing chip are respectively connected to one end of resistors R18 and R19, and the other ends of the resistors R18 and R19 are grounded, the 12 terminal of the six-axis motion processing chip is connected to the PB2 terminal of the micro-control chip, the 20 terminal of the six-axis motion processing chip is connected to one end of capacitor C23, and the other end of the capacitor C23 is grounded, the 1 and 18 terminals of the six-axis motion processing chip are both grounded, the 13 terminal of the six-axis motion processing chip is connected to one end of C24, and the end is also connected to a power supply of 3.3V, and the other end of C24 is grounded, the 10 terminal of the six-axis motion processing chip is connected to one end of capacitor C22, and the other end of the capacitor C22 is grounded, the 9 terminal of the six-axis motion processing chip is connected to one end of resistor R20, and the other end of resistor R20 is grounded, the 8 terminal of the six-axis motion processing chip is connected to one end of capacitor C24, and the other end of capacitor C24 is grounded.

[0012] Preferably, the Bluetooth module includes a BlueCore4-Ext chip, a P12 terminal of the BlueCore4-Ext chip is connected to one end of a resistor R6, the other end of the resistor R6 is connected to an anode of a diode L2, the cathode of the diode L2 is grounded, terminals 1 and 2 of the BlueCore4-Ext chip are connected to terminals PB11 and PB10 of the microcontroller chip, a terminal 12 of the BlueCore4-Ext chip is connected to one end of a capacitor C17, and the other end of the capacitor C17 is connected to terminal 13 of the BlueCore4-Ext chip.

[0013] Preferably, the clock circuit includes a capacitor C25 connected to the OSC_IN PD0 terminal of the micro-control chip and one end of the crystal oscillator Y2, the other end of the capacitor C25 is grounded, the other end of the crystal oscillator Y2 is connected to the OSC_OUT PD1 of the micro-control chip, and is also connected to one end of the capacitor C26, and the other end of the capacitor C26 is grounded.

[0014] Preferably, the filtering and current stabilizing circuit includes capacitors C21, C19, C18, and C20 respectively connected to the 9, 24, 36, and 48 terminals of the microcontrol chip, the other ends of the capacitors C21, C19, C18, and C20 are grounded, and the 9, 24, 36, and 48 terminals of the microcontrol chip are also respectively connected to a 3.3V power supply.

[0015] Preferably, the reset circuit includes a button S2 connected to the NRST of the microcontrol chip, a resistor R22 and one end of a capacitor C27, the other end of the capacitor C27 and the other end of the button S4 are both grounded, and the other end of the resistor R22 is connected to a 3.3V power supply.

[0016] Preferably,

[0017] The voltage stabilizing module includes a first voltage stabilizing circuit and a second voltage stabilizing circuit. The first voltage stabilizing circuit includes a chip IC1. The 3 and 5 terminals of the chip IC1 are grounded. The 1 terminal of the chip IC1 is connected to the capacitor C3, the capacitor C4 and one end of the resistor R2. The other ends of the capacitors C3 and C4 are grounded. The other end of the resistor R2 is connected to one end of the resistor R3 and one end of the capacitor C5. The other end of the resistor R3 is grounded. The other end of the capacitor C5 is grounded on one hand and connected to the 2 terminal of the interface P3 on the other hand. The 1 terminal of the interface P3 is grounded. The 2 terminal of the chip IC1 is connected to the cathode of the diode D1 and one end of the inductor L. The anode of the diode D1 is grounded. The other end of the inductor L is connected to the 4 terminal of the chip IC1, the anode of the capacitor C1 and one end of the capacitor C2. The cathode of the capacitor C1 and the other end of the capacitor C2 are grounded.

[0018] The second voltage stabilizing circuit includes a chip U2, wherein the terminal 1 of the chip U2 is connected to the cathode of the diode D2, one end of the capacitor C8, one end of the capacitor C6 and a 5V voltage, the anode of the diode D2, the other end of the capacitor C8 and the other end of the capacitor C6 are grounded, the terminal 3 of the chip U2 is grounded, the terminal 2 of the chip U2 is connected to one end of the capacitor C7, one end of the capacitor C9 and the cathode of the diode D3, the other end of the capacitor C7, the other end of the capacitor C9 and the anode of the diode D3 are grounded, the terminal 2 of the chip U2 provides power to the microcontrol chip and the six-axis motion processing module, and the terminal 4 of the chip IC1 provides power to the motor control module.

[0019] Beneficial technical effects of the present invention:

[0020] A laser tracking balance car control circuit provided by the present invention integrates wireless control, infrared tracking, and balance operation functions. On the basis of balance operation, a Bluetooth module is added for control, and then the motor drive control unit controls and adjusts the parameters of the wind wheel motor and the speed control motor through two interfaces P4 and P5, and then the adjustment parameter signal sent by the microcontroller chip is received through the buffer circuit of chip U1, so that the control of the two motor parameters is achieved through one control unit. The circuit structure is simple, and it can achieve the balance state when stationary by controlling the adjustment parameters of the wind wheel motor and the speed control motor, and at the same time, it can achieve the balance state when moving by controlling the speed control motor. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] Figure 1 A microcontroller chip and peripheral circuit diagram of a preferred embodiment of a laser tracking balance vehicle control circuit according to the present invention.

[0022] Figure 2 The present invention is a motor driving circuit diagram of a preferred embodiment of a laser tracking balance vehicle control circuit according to the present invention.

[0023] Figure 3 The present invention is a circuit diagram of a Bluetooth module according to a preferred embodiment of a laser tracking balance vehicle control circuit of the present invention.

[0024] Figure 4 The circuit diagram of the six-axis motion processing module of a preferred embodiment of a laser tracking balance vehicle control circuit according to the present invention.

[0025] Figure 5 The present invention is a circuit diagram of a voltage stabilizing module according to a preferred embodiment of a laser tracking balance vehicle control circuit of the present invention.

[0026] Figure 6 The present invention is a structural block diagram of a preferred embodiment of a laser tracking balance vehicle control circuit according to the present invention. DETAILED DESCRIPTION

[0027] In order to make the technical solution of the present invention more clear and specific to those skilled in the art, the present invention is further described in detail below in conjunction with embodiments and drawings, but the implementation manner of the present invention is not limited thereto.

[0028] like Figure 1-Figure 5 As shown, this embodiment provides a laser tracking balance vehicle control circuit.

[0029] The invention comprises a six-axis motion processing module, a Bluetooth module, a motor drive module, a micro-control chip, a voltage stabilizing module and a visual module, wherein the PB8, PB9 and PB52 terminals of the micro-control chip are connected to the six-axis motion processing module wires, the PB10 and PB11 terminals of the micro-control chip are connected to the Bluetooth module wires, the PB12, PB9, PB13, PB8, PB14, PB6, PB15, PB13, PA8, PB15, PA7, PA8 and PA121 terminals of the micro-control chip are connected to the motor drive module wires, the micro-control chip comprises a clock circuit and a reset circuit and a filtering and stabilizing current circuit connected thereto, wherein the OSC_IN PD0 and OSC_OUTPD1 terminals of the micro-control chip are connected to the clock circuit wires, and the VSSA, VSS_2, VSS_1, The VSS_3 terminal is grounded, the VDDA, VDD_2, VDD_1, and VDD_3 terminals of the microcontroller chip are externally connected to a voltage regulator module and connected to the wire of the filter and current stabilizing circuit, and the NRST terminal of the microcontroller chip is connected to the wire of the reset circuit. The motor drive module includes a motor drive control unit and an interface P4 and an interface P5. The motor drive control unit includes a chip U3, the 1 and 2 terminals of the chip U3 are connected, the 3 and 4 terminals of the chip U3 are connected and grounded, the 5 and 6 terminals of the chip U3 are connected, the 7 and 8 terminals of the chip U3 are connected, the 9 and 10 terminals of the chip U3 are connected and grounded, the 11 and 12 terminals of the chip U3 are connected, and the 15, 16, 17, 21, 22, and 23 terminals of the chip U3 are connected to the PB6 of the microcontroller chip. , PB13, PB14, PB15, PA8, and PA7 are connected respectively, the 19 and 20 terminals of the chip U3 are connected and connected to the voltage stabilizing circuit, the 13 and 14 terminals of the chip U3 are connected to the VS terminal of the interface P4 and the VS terminal of the interface P5 respectively, the GND terminal of the interface P4 is grounded, the IN and INH terminals of the interface P4 are connected to one end of the resistors R5 and R7 respectively, the other ends of the resistors R5 and R7 are connected to the ATN1 and AEN terminals of the chip U1 respectively, the OUT terminal of the interface P4 is connected to the speed control motor, the SR and IS terminals of the interface P4 are connected to one end of the resistor R9 and the resistor R11 respectively, and the other ends of the resistors R9 and R11 are grounded, and the GND terminal of the interface P4 is grounded;

[0030] The IN and INH terminals of the interface P5 are connected to one end of the resistors R6 and R8 respectively, the other ends of the resistors R6 and R8 are connected to the ATN2 and AEN terminals of the chip U1 respectively, the OUT terminal of the interface P5 is connected to the wind wheel control motor, the SR and IS terminals of the interface P5 are connected to one end of the resistor R10 and the resistor R12 respectively, and the other ends of the resistors R10 and R12 are grounded;

[0031] The 1A1, 1A2, 1A3 terminals of the chip U1 are connected to the PB9, PB8 and PA12 of the microcontroller chip respectively, and the 1A3 terminal of the chip U1 is grounded through the resistor R1, the 1Y1, 1Y2, 1Y3 of the chip U1 are connected to the chip U3, and the ground terminal of the chip U1 is grounded;

[0032] The microcontroller chip is used to store programs and receive control instructions sent by the Bluetooth module, and send control instructions to the motor drive module. When the balancing vehicle is moving, the speed control motor adjusts the parameters to ensure that the balancing vehicle maintains a balanced state and maintains a balanced state according to the movement trajectory;

[0033] The motor drive module is used to receive control instructions sent by the microcontroller chip, and send control instructions to the speed control motor and the wind wheel motor, so that the wind wheel motor and the speed control motor are adjusted according to the adjustment parameters sent by the single chip microcomputer.

[0034] In this embodiment, the six-axis motion processing module includes a six-axis motion processing chip, the 23 and 24 terminals of the six-axis motion processing chip are respectively connected to one end of resistors R18 and R19, and the other ends of the resistors R18 and R19 are grounded, the 12 terminal of the six-axis motion processing chip is connected to the PB2 terminal of the micro-control chip, the 20 terminal of the six-axis motion processing chip is connected to one end of capacitor C23, and the other end of the capacitor C23 is grounded, the 1 and 18 terminals of the six-axis motion processing chip are both grounded, the 13 terminal of the six-axis motion processing chip is connected to one end of C24, and the end is also connected to a power supply of 3.3V, and the other end of C24 is grounded, the 10 terminal of the six-axis motion processing chip is connected to one end of capacitor C22, and the other end of the capacitor C22 is grounded, the 9 terminal of the six-axis motion processing chip is connected to one end of resistor R20, and the other end of resistor R20 is grounded, the 8 terminal of the six-axis motion processing chip is connected to one end of capacitor C24, and the other end of capacitor C24 is grounded.

[0035] In the above, the six-axis motion processing chip MPU6050 is used to collect and process the posture angle and speed of the balance car, and then send it to the PB2 terminal of the microcontroller through the 12 terminal.

[0036] In this embodiment, the Bluetooth module includes a BlueCore4-Ext chip, a P12 terminal of the BlueCore4-Ext chip is connected to one end of a resistor R6, the other end of the resistor R6 is connected to an anode of a diode L2, the cathode of the diode L2 is grounded, terminals 1 and 2 of the BlueCore4-Ext chip are connected to terminals PB11 and PB10 of the microcontroller chip, a terminal 12 of the BlueCore4-Ext chip is connected to one end of a capacitor C17, and the other end of the capacitor C17 is connected to terminal 13 of the BlueCore4-Ext chip.

[0037] As mentioned above, the external control device can be connected to the microcontroller via the Bluetooth module.

[0038] In this embodiment, the clock circuit includes a capacitor C25 connected to the OSC_IN PD0 terminal of the micro-control chip and one end of the crystal oscillator Y2, the other end of the capacitor C25 is grounded, the other end of the crystal oscillator Y2 is connected to the OSC_OUT PD1 of the micro-control chip, and is also connected to one end of the capacitor C26, and the other end of the capacitor C26 is grounded.

[0039] As described above, the clock circuit generates a clock signal through the crystal oscillator Y2 and provides the clock signal to the microcontroller chip after filtering through the capacitors C25 and C26.

[0040] In this embodiment, the filtering and current stabilizing circuit includes capacitors C21, C19, C18, and C20 respectively connected to the 9, 24, 36, and 48 terminals of the microcontrol chip, the other ends of the capacitors C21, C19, C18, and C20 are grounded, and the 9, 24, 36, and 48 terminals of the microcontrol chip are also respectively connected to a 3.3V power supply.

[0041] In the above, the input power of the microcontroller chip is filtered through the capacitor to ensure that the input voltage is stable and reliable.

[0042] In this embodiment, the reset circuit includes a button S2 connected to the NRST of the microcontroller chip, a resistor R22, and one end of a capacitor C27, the other end of the capacitor C27 and the other end of the button S4 are both grounded, and the other end of the resistor R22 is connected to a 3.3V power supply.

[0043] In the above, the button S4 is grounded, so that the NRST terminal is grounded, thereby performing a reset process.

[0044] In this embodiment, the voltage stabilizing module includes a first voltage stabilizing circuit and a second voltage stabilizing circuit. The first voltage stabilizing circuit includes a chip IC1. The 3 and 5 terminals of the chip IC1 are grounded. The 1 terminal of the chip IC1 is connected to the capacitor C3, the capacitor C4 and one end of the resistor R2. The other ends of the capacitors C3 and C4 are grounded. The other end of the resistor R2 is connected to one end of the resistor R3 and one end of the capacitor C5. The other end of the resistor R3 is grounded. The other end of the capacitor C5 is grounded on one hand and connected to the 2 terminal of the interface P3 on the other hand. The 1 terminal of the interface P3 is grounded. The 2 terminal of the chip IC1 is connected to the cathode of the diode D1 and one end of the inductor L. The anode of the diode D1 is grounded. The other end of the inductor L is connected to the 4 terminal of the chip IC1, the anode of the capacitor C1 and one end of the capacitor C2. The cathode of the capacitor C1 and the other end of the capacitor C2 are grounded.

[0045] The second voltage stabilizing circuit includes a chip U2, wherein the terminal 1 of the chip U2 is connected to the cathode of the diode D2, one end of the capacitor C8, one end of the capacitor C6 and a 5V voltage, the anode of the diode D2, the other end of the capacitor C8 and the other end of the capacitor C6 are grounded, the terminal 3 of the chip U2 is grounded, the terminal 2 of the chip U2 is connected to one end of the capacitor C7, one end of the capacitor C9 and the cathode of the diode D3, the other end of the capacitor C7, the other end of the capacitor C9 and the anode of the diode D3 are grounded, the terminal 2 of the chip U2 provides power to the microcontrol chip and the six-axis motion processing module, and the terminal 4 of the chip IC1 provides power to the motor control module.

[0046] In the above, an external 12V power supply is connected through the interface P3 of the first voltage stabilizing circuit, and then a filter circuit is formed by capacitors C3, C4, resistors R2 and R3 for filtering and then input into the chip IC1, and then a 5V voltage is input, and after filtering through capacitors and inductors, it is output, and a 5V power supply is connected through the 1 connection terminal of the second voltage stabilizing circuit, and then after filtering through capacitors, it is input into the chip U2, and then a 3.3V voltage is output, wherein the chip U2 is an existing chip.

[0047] In this embodiment, the visual acquisition module is an OpenMV camera, which is connected to the PB10 and PB11 terminals of the microcontroller chip.

[0048] The control method of the balancing vehicle corresponding to the present invention comprises the following steps:

[0049] Step 1: receiving user operation via a mobile terminal;

[0050] Step 2: Send control instructions to the Bluetooth module through the mobile terminal;

[0051] Step 3: Send control information to the microcontroller chip via the Bluetooth module;

[0052] Step 4: The visual module collects laser signals and generates motion trajectories and sends them to the microcontroller chip;

[0053] Step 5: The microcontroller chip detects whether the balancing car is in a stationary state. If so, the six-axis processing module is used to obtain the angular deviation of the balancing car's posture, and then the wind wheel adjustment parameters are determined according to the PI algorithm to make the balancing car in a balanced state. If not, the six-axis processing module is used to obtain the spatial data of the balancing car's body posture, and then the speed control motor adjustment parameters are determined according to the PID algorithm to make the balancing car in a balanced state and move according to the motion trajectory.

[0054] Among them, the wind wheel adjustment parameters are determined according to the PI algorithm to make the balance car in a balanced state. Specifically, the six-axis processing module obtains the attitude angle and speed information of the balance car, and then differentiates the attitude angle to obtain the attitude angular velocity, and then according to the formula Get the wind wheel adjustment parameter a, where k, p and d are angle adjustment parameters, and is the speed adjustment parameter, is the speed information, B is the attitude angle, is the attitude angular velocity;

[0055] The voltage value required for the instantaneous rotation of the wind wheel motor is adjusted according to the determined wind wheel adjustment parameters. The wind wheel motor drives the wind wheel to accelerate under instantaneous acceleration to generate centrifugal acceleration to apply force to the car in the opposite direction so that the balance car is in a balanced state.

[0056] Among them, in step 5, determining the adjustment parameters of the motor drive module according to the PID algorithm so that the balancing vehicle is in a balanced state specifically includes:

[0057] 51: The proportional parameter is equivalent to the restoring force of the balance car falling down. This parameter should be greater than the acceleration of gravity. When the proportional parameter is gradually increased, the balance car can start to stay upright. The differential parameter is equivalent to the damping force. Adjusting the differential parameter is used to suppress the swing of the car model.

[0058] 52: When adjusting the proportional parameter P and the differential parameter D, the order of proportional first and differential second is followed. The proportional parameter is adjusted first so that the tracking self-balancing vehicle can remain upright and start to swing back and forth, and then the differential parameter is gradually increased. The tracking self-balancing vehicle gradually stands upright and stabilizes. The differential parameter is further increased until the two-wheeled self-balancing vehicle begins to resonate. At this point, the maximum value of the differential parameter is determined;

[0059] 53. Reduce the differential parameter, and then gradually increase the proportional parameter until the balancing vehicle starts to oscillate again, and thus determine the maximum value of the proportional parameter. Finally, output the motor speed adjustment parameter value of the DC motor module according to the adjusted proportional parameter and differential parameter.

[0060] To sum up, the wireless control, infrared tracking and balanced operation functions are integrated. On the basis of balanced operation, a Bluetooth module is added for control, and then the motor drive control unit controls the wind wheel motor and the speed control motor through the two interfaces P4 and P5 to adjust the parameters. Then, the buffer circuit of chip U1 receives the adjustment parameter signal sent by the microcontroller chip, and the control of the two motor parameters is achieved through one control unit. The circuit structure is simple, and it can achieve the balance state when stationary by controlling the adjustment parameters of the wind wheel motor and the speed control motor, and maintain the balance state when moving by controlling the speed control motor.

[0061] The above description is only a further embodiment of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical solutions and concepts of the present invention within the scope disclosed by the present invention, which belong to the protection scope of the present invention.

Claims

1. A laser tracking balance vehicle control circuit, characterized in that: The invention comprises a six-axis motion processing module, a Bluetooth module, a motor drive module, a micro-control chip, a voltage stabilizing module and a visual module, wherein the PB8, PB9 and PB52 terminals of the micro-control chip are connected to the six-axis motion processing module wires, the PB10 and PB11 terminals of the micro-control chip are connected to the Bluetooth module wires, the PB12, PB9, PB13, PB8, PB14, PB6, PB15, PB13, PA8, PB15, PA7, PA8 and PA121 terminals of the micro-control chip are connected to the motor drive module wires, the micro-control chip comprises a clock circuit and a reset circuit and a filtering and stabilizing current circuit connected thereto, wherein the OSC_INPD0 and OSC_OUTPD1 terminals of the micro-control chip are connected to the clock circuit wires, and the VSSA, VSS_2, VSS_1, The VSS_3 terminal is grounded, the VDDA, VDD_2, VDD_1, and VDD_3 terminals of the microcontroller chip are externally connected to a voltage regulator module and connected to the wire of the filter and current stabilizing circuit, and the NRST terminal of the microcontroller chip is connected to the wire of the reset circuit. The motor drive module includes a motor drive control unit and an interface P4 and an interface P5. The motor drive control unit includes a chip U3, the 1 and 2 terminals of the chip U3 are connected, the 3 and 4 terminals of the chip U3 are connected and grounded, the 5 and 6 terminals of the chip U3 are connected, the 7 and 8 terminals of the chip U3 are connected, the 9 and 10 terminals of the chip U3 are connected and grounded, the 11 and 12 terminals of the chip U3 are connected, and the 15, 16, 17, 21, 22, and 23 terminals of the chip U3 are connected to the PB6 of the microcontroller chip. , PB13, PB14, PB15, PA8, and PA7 are connected respectively, the 19 and 20 terminals of the chip U3 are connected and connected to the voltage stabilizing circuit, the 13 and 14 terminals of the chip U3 are connected to the VS terminal of the interface P4 and the VS terminal of the interface P5 respectively, the GND terminal of the interface P4 is grounded, the IN and INH terminals of the interface P4 are connected to one end of the resistors R5 and R7 respectively, the other ends of the resistors R5 and R7 are connected to the ATN1 and AEN terminals of the chip U1 respectively, the OUT terminal of the interface P4 is connected to the speed control motor, the SR and IS terminals of the interface P4 are connected to one end of the resistor R9 and the resistor R11 respectively, and the other ends of the resistors R9 and R11 are grounded, and the GND terminal of the interface P4 is grounded; The IN and INH terminals of the interface P5 are connected to one end of the resistors R6 and R8 respectively, the other ends of the resistors R6 and R8 are connected to the ATN2 and AEN terminals of the chip U1 respectively, the OUT terminal of the interface P5 is connected to the wind wheel control motor, the SR and IS terminals of the interface P5 are connected to one end of the resistor R10 and the resistor R12 respectively, and the other ends of the resistors R10 and R12 are grounded; The 1A1, 1A2, 1A3 terminals of the chip U1 are connected to the PB9, PB8 and PA12 of the microcontroller chip respectively, and the 1A3 terminal of the chip U1 is grounded through the resistor R1, the 1Y1, 1Y2, 1Y3 of the chip U1 are connected to the chip U3, and the ground terminal of the chip U1 is grounded; The microcontroller chip is used to store programs and receive control instructions sent by the Bluetooth module, and send control instructions to the motor drive module. When the balancing vehicle is moving, the speed control motor adjusts the parameters to ensure that the balancing vehicle maintains a balanced state and maintains a balanced state according to the movement trajectory; The motor drive module is used to receive control instructions sent by the microcontroller chip, and send control instructions to the speed control motor and the wind wheel motor, so that the wind wheel motor and the speed control motor are adjusted according to the adjustment parameters sent by the single chip microcomputer; The microcontroller chip detects whether the balancing car is in a stationary state. If so, the six-axis processing module is used to obtain the angular deviation of the balancing car's posture, and then the wind wheel adjustment parameters are determined according to the PI algorithm to make the balancing car in a balanced state. If not, the six-axis processing module is used to obtain the spatial data of the balancing car's body posture, and then the speed control motor adjustment parameters are determined according to the PID algorithm to make the balancing car in a balanced state and move according to the motion trajectory. According to the PI algorithm, the wind wheel adjustment parameters are determined to make the balance car in a balanced state. Specifically, the six-axis processing module obtains the attitude angle and speed information of the balance car, and then differentiates the attitude angle to obtain the attitude angular velocity, and then according to the formula Get the wind wheel adjustment parameter a, where k, p and d are angle adjustment parameters, and is the speed adjustment parameter, is the speed information, B is the attitude angle, is the attitude angular velocity.

2. A laser tracking balance vehicle control circuit according to claim 1, characterized in that: The six-axis motion processing module includes a six-axis motion processing chip, wherein the 23 and 24 terminals of the six-axis motion processing chip are respectively connected to one end of resistors R18 and R19, and the other ends of the resistors R18 and R19 are grounded, the 12 terminal of the six-axis motion processing chip is connected to the PB2 terminal of the microcontrol chip, the 20 terminal of the six-axis motion processing chip is connected to one end of a capacitor C23, and the other end of the capacitor C23 is grounded, the 1 and 18 terminals of the six-axis motion processing chip are both grounded, the 13 terminal of the six-axis motion processing chip is connected to one end of C24, and the end is also connected to a power supply of 3.3V, and the other end of C24 is grounded, the 10 terminal of the six-axis motion processing chip is connected to one end of a capacitor C22, and the other end of the capacitor C22 is grounded, the 9 terminal of the six-axis motion processing chip is connected to one end of a resistor R20, and the other end of the resistor R20 is grounded, the 8 terminal of the six-axis motion processing chip is connected to one end of a capacitor C24, and the other end of the capacitor C24 is grounded.

3. A laser tracking balance vehicle control circuit according to claim 1, characterized in that: The Bluetooth module includes a BlueCore4-Ext chip, a P12 terminal of the BlueCore4-Ext chip is connected to one end of a resistor R6, the other end of the resistor R6 is connected to the anode of a diode L2, the cathode of the diode L2 is grounded, terminals 1 and 2 of the BlueCore4-Ext chip are connected to terminals PB11 and PB10 of the microcontroller chip, a terminal 12 of the BlueCore4-Ext chip is connected to one end of a capacitor C17, and the other end of the capacitor C17 is connected to terminal 13 of the BlueCore4-Ext chip.

4. A laser tracking balance vehicle control circuit according to claim 1, characterized in that: The clock circuit includes a capacitor C25 connected to the OSC_IN PD0 terminal of the microcontrol chip and one end of the crystal oscillator Y2, the other end of the capacitor C25 is grounded, the other end of the crystal oscillator Y2 is connected to the OSC_OUTPD1 of the microcontrol chip and is also connected to one end of the capacitor C26, and the other end of the capacitor C26 is grounded.

5. The laser tracking balance vehicle control circuit according to claim 1, characterized in that: The filtering and current stabilizing circuit includes capacitors C21, C19, C18, and C20 respectively connected to the 9, 24, 36, and 48 terminals of the microcontrol chip, the other ends of the capacitors C21, C19, C18, and C20 are grounded, and the 9, 24, 36, and 48 terminals of the microcontrol chip are also respectively connected to a 3.3V power supply.

6. A laser tracking balance vehicle control circuit according to claim 1, characterized in that: The reset circuit includes a button S2 connected to the NRST of the microcontroller chip, a resistor R22 and one end of a capacitor C27, the other end of the capacitor C27 and the other end of the button S4 are both grounded, and the other end of the resistor R22 is connected to a 3.3V power supply.

7. A laser tracking balance vehicle control circuit according to claim 1, characterized in that: The voltage stabilizing module includes a first voltage stabilizing circuit and a second voltage stabilizing circuit. The first voltage stabilizing circuit includes a chip IC1. The 3 and 5 terminals of the chip IC1 are grounded. The 1 terminal of the chip IC1 is connected to the capacitor C3, the capacitor C4 and one end of the resistor R2. The other ends of the capacitors C3 and C4 are grounded. The other end of the resistor R2 is connected to one end of the resistor R3 and one end of the capacitor C5. The other end of the resistor R3 is grounded. The other end of the capacitor C5 is grounded on one hand and connected to the 2 terminal of the interface P3 on the other hand. The 1 terminal of the interface P3 is grounded. The 2 terminal of the chip IC1 is connected to the cathode of the diode D1 and one end of the inductor L. The anode of the diode D1 is grounded. The other end of the inductor L is connected to the 4 terminal of the chip IC1, the anode of the capacitor C1 and one end of the capacitor C2. The cathode of the capacitor C1 and the other end of the capacitor C2 are grounded. The second voltage stabilizing circuit includes a chip U2, wherein the terminal 1 of the chip U2 is connected to the cathode of the diode D2, one end of the capacitor C8, one end of the capacitor C6 and a 5V voltage, the anode of the diode D2, the other end of the capacitor C8 and the other end of the capacitor C6 are grounded, the terminal 3 of the chip U2 is grounded, the terminal 2 of the chip U2 is connected to one end of the capacitor C7, one end of the capacitor C9 and the cathode of the diode D3, the other end of the capacitor C7, the other end of the capacitor C9 and the anode of the diode D3 are grounded, the terminal 2 of the chip U2 provides power to the microcontrol chip and the six-axis motion processing module, and the terminal 4 of the chip IC1 provides power to the motor control module.