You are on page 1of 4

2020 IEEE International Conference on Power, Intelligent Computing and Systems (ICPICS)

Research on Embedded Intelligent Robot and Its


Motion Control System

Yufeng Liang
School of Innovation and Entrepreneurship Education
Dalian Jiaotong University
Dalian, China
lyf176@vip.qq.com

Abstract—The realization of an intelligent robot and its two-way data At the same time of transmission, the burden
motion control system requires a combination of various of the interrupt service on the CPU is reduced to complete
hardware and software modules such as processors, infrared the flexible configuration of the interrupt priority.
sensors, motion control, and geomagnetic navigation to Afterwards, the three PWM signal generation modules,
accurately control the robot's basic movements and walking including counters, comparators, and signal generators, are
lines to avoid movement Robot collision or abnormal state. mainly used for infrared emission in the circuit. And motor
This paper uses the Windows software operating system, drive [3-4].
Visual C++, etc. to develop and design mobile robot embedded
control programs, application processing modules, and B. Power Module
multi-task mechanisms to achieve algorithmic tracking and The power module includes three components: motor
tracking of mobile robot motion paths control.
power supply, motor drive, and system modular power
Keywords—Embedded, Intelligent robot, Motion control,
supply. In this paper, the battery charging mode is selected
System to provide power for the intelligent robot motor. The rated
voltage of the motor is controlled between 9 ~ 12V, and the
I. INTRODUCTION input current of the motor is 120mA. Therefore, the use of a
2000mA / h battery can meet the basic work requirements.
At present, most intelligent robots use microprocessors
Moreover, the battery will reduce the voltage value while
and common programming languages such as C language
the power is reduced, and it will also affect the normal
and Visual C++ to design a variety of application functions
operation and control of the motor, so the maximum voltage
and control algorithms[1]. This relies on standard operating
value of the motor must also be adjusted in time[5]. By
systems, program development frameworks, and standard
selecting the ASM1117 power chip and the TA780sF linear
bus structure, I/O hardware connection mode, the
voltage chip, the output voltage value is adjusted to about 5
developed mobile robot motion control system will get rid
V to effectively ensure the stable operation of the wireless,
of the problem of singular and closed storage of traditional
main control chip, geomagnetic navigation and other
EPROM data information, strengthen the hardware and
modules.
software architecture in the system, and interface with
external network devices and sensors[2]. The C. Infrared Sensor Module
interconnection between each other enables the entire robot The entire process of intelligent robot travel and motion
control platform to share data, and finally completes the control requires infrared sensors to be involved. Infrared
control and testing of various walking routes and actions of sensors are mainly used to identify directions and identify
the robot. obstacles, etc., and include a transmitter head and a receiver
II. HARDWARE STRUCTURE OF EMBEDDED INTELLIGENT head[6]. The transmitter head emits a certain frequency to
the outside. Infrared, and then the receiving head receives
ROBOT SYSTEM
the infrared, and the internal decoding circuit, automatic
A. Processor Module gain circuit, band-pass filter circuit make the frequency
The intelligent robot main control chip selects the discrimination of the sensitive signal, and the main control
LM3S615 chip, which is an ARM7 series Cortex-M3 32-bit processor detects the change of the voltage of the receiving
architecture, which can be used for automatic control of head to achieve Obstacle distance, direction and other
digital processing plants, buildings and other spaces, can information measurement. The main control chip controls
provide users with more precise functional service the infrared emission head through the current limiting
requirements, and has more Low price. The chip uses the resistor, adjusts the infrared emission intensity, and uses 6
Thumb-2 instruction set and the operating frequency is sets of infrared transceiver modules to detect the distance in
50MHz, which can help users set the priority level of the front, back, left, or diagonal directions [7].
interrupt controller (NVIC), and provide write clear, D. Motion Control Module
decrement, self-loading counter, privileged mode, etc.
The motion control module is the most critical part of
Ensure system security during data access and storage.
the intelligent robot's motion control, including the motor
There are 2 fully programmable serial port transceivers,
encoder, mechanical power structure, drive circuit, etc., if
integrated I2C bus, with independent 16x8 transmit (TX)
the intelligent robot's motion control module fails, it cannot
and 16x12 receive (RX) FIFO, which can be used in

978-1-7281-9874-3/20/$31.00 ©2020 IEEE 934 July 28-30, 2020•Shenyang, China

Authorized licensed use limited to: CALIFORNIA INSTITUTE OF TECHNOLOGY. Downloaded on November 02,2020 at 05:18:10 UTC from IEEE Xplore. Restrictions apply.
complete the follow-up application and control algorithm supply and voltage control are completed through the two
instruction requirements [8]. The closed-loop control of the input and output terminals of the motor M1 and M2. Pay
stepper motor is selected, and the feedback device of the attention to the positive and negative electrodes when
power source is added, such as the encoder feedback device, entering, and the voltage range in the entire circuit is
to control the motor steering, speed, or angle of rotation. controlled between 5 ~ 7V [10].
Later, in the design of the mechanical power III. SOFTWARE FUNCTION DESIGN OF EMBEDDED
transmission structure of the intelligent robot, metal INTELLIGENT ROBOT SYSTEM
brackets, wheels, bearings and other components are usually
used to complete the construction of the main structure of This intelligent robot is based on the two channels of the
the robot. The wheel gears must match the parameters of the ADT-850 motion control card and controls the left and right
motor gears, and then different types of fixed brackets must wheel drives of the intelligent robot car body. The operation
be purchased., Nuts and other components are to achieve the functions of these wheel channels are packaged into
construction of the overall mechanical structure of the corresponding development library functions, which are
intelligent robot. Here set the motor sampling period to defined as CAdt Motor Ctrl functions. Using other function
10ms and motor speed to 15r/s. Then design the drive instruction programming to control the movement, rotation,
circuit around the motor, select the L298 drive chip, H or other posture states of the intelligent robot system can be
bridge circuit to control the output power of the motor drive defined as Robot ActionCtrl and other functions. Therefore,
circuit. The input end of the drive circuit is directly in the embedded intelligent robot system, the thread
connected to the main control chip, and the power supply architecture of specific task instruction priority is shown in
mode of the drive chip is adopted [9]. The motor power Figure 1 Shown:

Fig.1 Thread Architecture Diagram

The user can use the wireless transmission serial port to time periods, and place path tracking, posture status
represent the coordinate information, rotation angle, motor monitoring, etc. at the highest priority position. Real-time
speed, etc. of the current intelligent robot, as well as the acquisition of high-precision data signals, through the
battery voltage and current working conditions, using a arrangement of different thread priority levels, to solve the
series of waveform comparison curves to represent, problems of system response triggering, thread resource
respectively labeled as coordinate points (x, y), Motor speed contention, etc., among which the DT85 motion control card
r, motor speed r/s. Through the above software and can independently process commands without the help of
hardware settings, it can basically ensure the detection of the main control chip. Events such as hard interrupts and
intelligent robot motion parameters, control program emergency stops will further enhance the real-time
execution and function expansion. Among them, posture effectiveness of the entire control system.
status monitoring, that is, the angle of robot motion for
monitoring, it is necessary to use infrared sensors to collect IV. RESEARCH ON MOTION CONTROL ALGORITHM BASED
input signals and return them to the main control chip of the ON EMBEDDED INTELLIGENT ROBOT
mobile robot for posture analysis. Path tracking usually uses The motion path of the intelligent robot in the plane will
corresponding algorithms to calculate the changes in the be affected by the movement of the car, the sliding of the
control signal of the drive system [11]. The sensor gimbal tires or the sand on the ground as the walking distance
control module mainly multiple infrared sensors are used to continues to increase, and the deviation of the
monitor and control the motion information of intelligent administrative route and the speed of movement will occur.
robots at different angles, and the communication module is The gap between the expected trajectories can be adjusted
responsible for data communication between the motion by infrared distance sensor probes and motion control
control and the main control chip [12]. algorithms to adjust the robot's movement route. In this
In order to ensure the real-time response of the paper, the motion control path tracking algorithm is selected
intelligent robot control system, adopt the API control to accurately analyze the kinematics of mobile robots and
function predefined by Windows, make priority build a perfect Mathematical model of the state feedback
arrangements for thread tasks in different areas and different path. First set v left and v right as the speed of the left and
right wheels of the intelligent robot, then its angular velocity

935

Authorized licensed use limited to: CALIFORNIA INSTITUTE OF TECHNOLOGY. Downloaded on November 02,2020 at 05:18:10 UTC from IEEE Xplore. Restrictions apply.
and linear velocity are ω = V right -V left/W, V=V left + V coordinate formula is (X, y, θ), (x, y) is the position of the
right/2, where W is the distance between the left and right robot's center coordinate in the origin coordinate system,
wheels of the robot. and θ is the angle between the intelligent robot and the x
axis, assuming The expected trajectory path of f (x, y) = 0 is
According to the above data, the intelligent robot pose shown in Figure 2[13].

Fig.2 Trajectory Path

Assuming that f ( x, y )=0 is the trajectory path equation occur, so it is necessary to choose a suitable k1 the value
expected by the intelligent robot, and ( x, y ) is the current of f y * keeps it moving like a circle on the desired
coordinate position of the robot, you can get x  v cos , trajectory[17].
y  v sin 
and  = , so that you can the displacement V. CONCLUSION
control quantity is converted into linear velocity v and
The motion control of the embedded intelligent robot
angular velocity control quantity. Set d  f ( x, y ) , then. mainly adopts technologies such as Windows operating
d  f x * x  f y * y  f x * vcos +f y * vsin [14]. system, Visual C ++ programming, and multi-threaded task
processing mechanism to complete the function debugging
Then perform function decomposition on and program design of the entire control system. The
fx and fy again to motion module is constructed for the entire intelligent robot
get d  f xx * v2cos 2  f yy * v2sin 2  2 f xy v 2 motion control. The core, through the use of motion control
algorithms, determines and manages whether the robot can
sin  cos   ( f y * v cos   fx * v sin  ) . do various actions and route movements, which can
effectively meet the mobile robot's mobile control needs.
Therefore, in the d  f ( x, y ) equation =f y* vcos
 -f x* vsin . [15] REFERENCES
[1] Li Xin, Lu Gang, Li Qirui. Design of driving wheel controller for
For the desired trajectory equation f ( x, y )  0 , the wheeled robot based on fuzzy pid algorithm. Micromotor, no.11,
pp.105-106, 2011.
radius of curvature of each point in the trajectory is R ( x, y ) , [2] Ji Binming, Pan Baozhu, Sun Jing. Design of somatosensory
then the relationship between the radius of curvature and the intelligent wheeled robot. Science and Technology Innovation and
V, ω parameters of the intelligent robot is R( x, y )  V /  . Application, no.12, pp.98-99, 2017.
[3] Lu Zhenli, Tian Kai, Liu Shujun, Li Bin. Design of football robot
So in the whole equation V  Vleft  Vright / 2 is usually kept interactive rule control system. Computer simulation, no.5,
constant, then only the angular velocity   Vright  Vleft / W is pp.202-203, 2015.
[4] Tan Huisheng, Liao Wen. Application of fuzzy pid in steering control
required, that is Find the control ratio of Vright  Vleft . Since of wheeled robots. Journal of Hunan University of Technology, no.1,
pp.45-46, 2018.
the d  f ( x, y ) equation is limited by the value of Δ, Then,
[5] Zhang hangming, Development and application of control system of
at D = f (x, y), it is necessary to control the value of new intelligent robot. Automation Application, no.3, pp.131-132,
value =f y x  f x y of the trajectory equation, which can be 2018.
converted into a function curve equation d  f ( x, y ) slope [6] Zhang Wanxu, Zhang Xianglan Li Ying, Path planning for intelligent
robots based on improved particle swarm optimization algorithm.
k1 , k 2 solution problem[16]. Journal of Computer Applications, no.2, pp.510-513, 2014.
[7] Yan Zheng, Lu Guoqiang, Wei Meili. Design of Intelligent Motion
Assuming that the expected trajectory of the intelligent Controller.Industrial Control Computer, vol.30, no.10, pp.51-52,
robot is x2  y2  16  0 , the average linear velocity is 2017.
[8] Lin Yong-qiang, Wang Yong, Feng Yi-zhao. The technology status
0.2m/s, and ω=0.05rad/s, then if k1 and k 2 are If it is small, and tendency of the open motion controller. INFORMATION
the control time for V right -V left to reach stability is poor. TECHNOLOGY, no.5, pp.184-186, 2010.
If the values of k1 and k 2 are large, unstable fluctuations may [9] Li Lei, Ye Tao, Tan min, Chen Xijun. Present state and future

936

Authorized licensed use limited to: CALIFORNIA INSTITUTE OF TECHNOLOGY. Downloaded on November 02,2020 at 05:18:10 UTC from IEEE Xplore. Restrictions apply.
development of mobile robot technology research. robot, vol.24, no.5, [15] Sun Jin-hua, Jiang Liang-zhong. Control system design of domestic
pp.475-480, 2002. robots with multi-function based on embedded. WEB. MACHINERY
[10] Tan Min, Fan Yong, Xu Guo-hua. Research on control and DESIGN & MANUFACTURE, no.8, pp.8-10, 2010.
co-operation for swarm robot systems. ROBOT, vol.23, no.2, [16] Zhang Hongyang, He Yongyi, Fan Xiangwen. Design of Industrial
pp.178-182, 2001. Robot Controller Based on ReWorks. Industrial Control Computer,
[11] Cai min, Path planning application of embedded intelligent robot. vol.29, no.7, pp.25-29, 2016.
China New Telecommunications, vol.20, no.24, pp.117-118, 2018. [17] Yao Yirong, Fu Zhongyun, Zhang Ruijia. Research on unknown
[12] Li yong. Research and design of intelligent interactive toy robot. space exploration robot system based on autonomous path planning,
Practical Electronics, no.19, pp.39-41, 2019. Jiangsu Science & Technology Information, vol.36, no.11, pp.47-49,
2019.
[13] Zhao Guofei, Bian Hongning. The design of intelligent fight training
robot. Internet of things technologies, vol.8, no.6, pp.29-31, 2018 [18] Liu jiuchen, yuan zuqiang, Yin chenbo. Kinematic analysis of delta
robot. Machinery, vol.57, no.12, pp.48-51, 2019.
[14] Li Jiaqi, Wang Xitong, Ding Zhaohong. Tracking Control of
Intelligent Mobile Robot Based on Embedded Environment,Journal [19] G. H. Rosa, J. P. Papa (2019). Soft-Tempering Deep Belief Networks
of Shanghai Institute of Technology(Natural Science), vol.16, no.3, Parameters Through Genetic Programming. Journal of Artificial
pp.271-274, 2016. Intelligence and Systems, 1, 43–59.

937

Authorized licensed use limited to: CALIFORNIA INSTITUTE OF TECHNOLOGY. Downloaded on November 02,2020 at 05:18:10 UTC from IEEE Xplore. Restrictions apply.

You might also like