Aece Electronics
Aece Electronics
point and straight lines for the indoor environment [10]. II. WHEELCHAIR MODELING
Design of a line following wheelchair for visually impaired The general structure of a power wheelchair consists of
and paralyzed patients is also one of the indoor environment the chassis, two front free wheels (casters), and two driven
studies [11-12]. As a particular task in this study, we tackle rear wheels, as presented in Fig. 1. Two rear wheels are
sidewalk following in outdoor environment. driven separately by two DC motors. To obtain the
Some previous studies have already touched the problem mathematical model of the power wheelchair, some
of sidewalk following. A pedestrian based approach makes assumptions and limitations are introduced below.
use of natural human motion to allow a robot to adapt to
sidewalk navigation [13]. Vision based navigation studies
are modelled on mobile robot model [14-15]. Another study
is related with curb detection for road and sidewalk
detection proposed for mobile robots [16]. In the present
study, we aim to develop a solution for wheelchair motion
model to follow yellow tactile pavement on the sidewalk
based on visual data.
This study does not need the presence of a pedestrian and
the wheelchair model is compatible for application of a
variety of control design methods. In addition to that, Hough
Lines method is employed which has been extensively used
as a powerful algorithm for extracting straight lines from Figure 1. Power wheelchair model
images. For controller design, mathematical model of the
wheelchair is developed with the purpose of vision based Assumptions:
navigation. A study that relates optimal tuning of dynamic 1. Friction forces on motor armature are negligible;
controller via LQR in a power wheelchair is available in 2. No slipping occurs on the ground and the wheels;
literature [17], but it is focused only on dynamic and 3. Cornering forces are negligible.
kinematic model of the wheelchair. Another study related In building the mathematical model of the wheelchair
with balancing control of wheelchair system includes LQR dynamics shown in Fig. 1, it is taken into consideration that
controller design [18], which differs from our work in the torque is applied to the wheels by the DC motors, and the
aspect of using principle of wheeled inverted pendulum wheels are moved by the horizontal forces Fh exerted at the
model. center of the wheel along the horizontal coordinate axis. The
Available in related literature is a study on automatic line wheelchair movement in the vertical direction is taken as
following navigation system for an intelligent robotic zero, so the deflection angle θ and displacement of the
wheelchair using fuzzy control [19-20], which needs a fuzzy wheelchair x are calculated from x and y coordinate
logic table instead of system modeling. However, this movements only. The equation of motion for the right and
method depends on the designer’s control experience on the left rear wheels is derived using Newton’s second law of
system and the fuzzy control table contains many motion.
parameters as well as tedious and complicated experiments Equation (1) represents the dynamic model for the
[21]. wheels, where equations of motion are derived using Table I
Additionally, many recent studies show that LQR and PP for wheelchair parameters and Assumptions 1 and 3 are
gives very good results on path tracking [22-25], so we applied [18].
decided to apply LQR and PP controllers to our model. In I k k k
x 2 m Va 2 m e Fh
2( w2 mw ) (1)
the light of and as an addition to the extensive research that rw Rrw Rrw
has been carried out on comparison of LQR and PP control
Also, the equation of motion for the chassis is derived by
[26-31], this paper presents new results on the two methods
using Newton’s second law of motion using Assumptions 1
with applications to the vision based wheelchair control
to 3 as in (2) and (3).
problem.
I k k k
The aim of this study is to assess the performances and (2 w2 2mw m p )
x 2 m Va 2 m 2e x
investigate the differences between LQR and PP controllers rw Rrw Rrw (2)
so that an efficient control methodology can be decided m p l cos( ) m p l 2 sin( )
based on visual data.
The rest of the paper is structured as follows. In the k k k
( I p m p l 2 ) 2 m Va 2 m e
x m p lx cos( ) (3)
second section, we present the mathematical model of the R Rrw
wheelchair and its linearized state space model. The third
The model is linearized around the operating point of:
section is devoted to image modelling and controller design.
The computational results obtained through the application 0 and ( d / dt ) 2 0
of the proposed methodology are presented in fourth section. Then, the linearized equations of motion become:
Experimental study, hardware of the system and results are 2k a 2k k a m 2p gl 2
shared in the fifth section. Some brief conclusions and x m Va m 2 e x
(4)
Rrw b Rrw b b
future perspectives are given in the last section.
4
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
5
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
equation (17). More points that lie on the same line tend to
more lines in Hough domain and that will increase voting to
the intersection point indicating that there are many points
that belong to the line in image domain with that slope and
y-intercept [34].
Figure 3. Image space and parameter space of any image to detect lines
for sidewalk following
Figure 6. Theta angle and vanishing point on the yellow line-sidewalk
( (
) d)
Figure 7. More examples for image extracted features on the yellow line-
sidewalk: a) example-1; b) example-2; c) example-3; d) example-4
6
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
fundamental control methods applicable to many advanced The elements of Q and R matrices are selected from the
control problems. Thus, LQR controller has good potential Bryson’s rule combined with trial-and-error [40].
for combining the orthogonal collocation optimization to State feedback gain KLQR is provided by the following
upgrade the optimization and control performances of equations (22-24):
dynamic systems with disturbances [37]. K LQR R 1 B T P (22)
On the other hand, PP control method is quite popular in
control design for letting the control designers choose their U K LQR x (23)
desired performance through preferred closed-loop pole AT P PA Q PBR 1 B T P 0 (24)
locations [38]. where the Algebraic Riccati Equation in (24) is used here to
The stability and various control performance indicators find P that represents constant matrix and calculated to find
of a closed-loop linear time-invariant system mostly depend optimal input of the system. So, KLQR gain matrix is:
on pole locations. For this reason, the poles of the closed-
K LQR 3.1623 20.4120 142.3382 0.7952 (25)
loop system should be located at those positions that have
rational and expected performance during control system 2) PP controller
design. There are several approaches for selection of pole
In modern feedback control, it is possible to collect more locations for good design. We have used Dominant Second
control information through state feedback in linear and Order Poles approach for PP controller design here. The
time invariant systems. Accordingly, state feedback has approach focuses on pole selection without explicit regard
been widely applied in deriving optimal control law and for their influence on control effort; but, the designer is able
eliminating the effect of disturbances [39]. In this research, to temper the choices to take control effort into account. The
it is aimed to apply two control methods of LQR and PP in pole which is nearer to the origin or imaginary axis is
state feedback configuration because of above mentioned referred to as a dominant pole. When we look at the poles of
reasons. the system, it can be seen that the nearest pole to the origin
is the real pole located at -0.0744. Poles with multiplicity
should not be greater than rank of B matrice, so the other
pole can be selected as -0.075. The rise time, overshoot and
settling time can be deduced directly from the pole
locations. Damping ratio ζ=1 will meet the overshoot
requirement and for this damping ratio, a rise time of 6 sec.
suggests a natural frequency ωn of about 1. There are four
poles in total, so the other two need to be placed far from the
dominant pair; for our purposes, “far ” means the transients
Figure 8. Visual data based control block diagram due to the fast poles should be over (significantly faster)
well before the transients due to the dominant poles and we
Performances of the two control methods are tested on the assume a factor of 1 in the respective undamped natural
wheelchair model, which is known to be completely state frequencies to be adequate [41]. From these considerations
controllable, and results are shared in section IV. Visual data desired poles are given in the following matrix:
based control block diagram of the proposed feedback
pole 1 i 1 i 0.075 0.0744 (26)
system for sidewalk following control is shown in Fig. 8.
1) LQR controller To find the control gain for PP, Kpp with desired poles,
As a state-feedback controller, LQR algorithm is applied well known Ackermann’s formula is used [42].
on the wheelchair model. State feedback law is designed K 0 0 0 1 S 1 ac ( A) (27)
with the purpose of minimizing the cost function given in where matrix A is defined in Equation (10) and matrix S is
(19), given by:
¥
S B A2 B An 1 B
J ( x Qx u Ru ) dx AB (28)
T R
(19)
0 and the notation ac(A) is given by:
where x and u are determined earlier in Equation (10) that ac ( A) An an 1 An 1 a1 A a0 I (29)
represent the state variables of the model and the input
So, Kpp is calculated from equations (27-29) as:
voltage to provide motion of the wheelchair respectively.
One of the weighting matrices Q that is used to penalize K pp 0.0057 4.0682 71.3825 0.9229 (30)
bad performance is selected as: 3) Overall system
10 0 0 0 Overall system’s operation procedure for both controllers
0 is shown in the Figs. 9 and 10 in the form of a flowchart.
10 0 0
Q The architecture of the proposed system comprises two main
(20)
0 0 10 0 sections. First section is visual feature extraction and this
common part is identical for the both control methods. As
0 0 0 5 obviously seen in the flowcharts, θ value is the output of the
and the other weighting matrix R that is used to penalize image processing part. Then, the angle θ is used for
actuator effort is selected as: generating the state reference signal of both controllers.
R (1) (21)
7
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
8
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
9
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
Figure 16. Simulation model for observing disturbance attenuation performance of LQR controlled model
10
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
Figure 17. Random noise added to theta state of the LQR controlled model
Figure 21. Step disturbance added to theta state of the PP controlled model
Figure 18. Step disturbance added to theta state of the LQR controlled
model Figure 22. Square wave disturbance added to the PP controlled model
11
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
V. ROBUSTNESS TO BODY WEIGHT VARIATIONS A 24V DC battery is employed to supply power to both
Simulation tests up to this point are realized for an the wheelchair's motors and the Sabertooth motor driver.
average body mass of 75.4 kg with the moment of inertia Additionally, a separate 5V DC power source is utilized to
0.44 kg.m2. In order to verify the robustness of proposed energize the Raspberry Pi module and the camera. The
controller to variations of driver mass, the model is also Sabertooth motor driver is used to control the movement of
tested for various body masses and corresponding moments the motors of the wheelchair. Communication between the
of inertia. Sabertooth module and Raspberry Pi is established via serial
With this purpose, eight different body mass values communication protocols. For a more comprehensive
between 40-150 kg and moments of inertia between 0.234- understanding of the interconnections and the physical
0.875 kg.m2 are simulated in computer environment. The positioning of these components on the actual wheelchair,
test results are shown in Fig. 23, and a zoomed-in view is refer to Fig. 26.
presented in Fig. 24 to better observe the results. The The Sabertooth motor driver facilitated wheelchair
graphical results show that the proposed LQR controlled movement based on velocity signals from the Raspberry Pi.
model is stable and robust to driver mass variations, with This entire process runs at about 7 Hz, taking around 143 ms
minimal deviation from the set value. The steady-state error per motion cycle. This frequency ensures prompt interaction
variation between the assumed minimum and maximum among system components, ensuring efficient wheelchair
mass values is only 0.21 percent. movement.
Figure 23. Step responses LQR controlled model for various values of the
body weight and inertia
12
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
REFERENCES
[1] L. I. Iezzoni, E. P. Mccarthy, R. B. Davis and H. Siebens, “Mobility
difficulties are not only a problem of old age,” Journal of General
Internal Medicine, vol. 16, pp. 235–243, 2001. doi:10.1046/j.1525-
1497.2001.016004235
[2] Turkey Health Interview Survey, “The percentage of individuals not
able to walk, walk up and down stairs without any aid or assistance by
sex and age group, 2008, 2010, 2012, 2014, 2016,” 2018.
https://data.tuik.gov.tr/Kategori/GetKategori?p=Saglik-ve-Sosyal-
Koruma-101 (accessed Nov. 23, 2023)
Figure 27. Experimental results for LQR and PP controlled model [3] J. Leaman and H. M. La, “A comprehensive review of smart
wheelchairs: past, present and future,” IEEE Transactions on Human-
Machine Systems, 47, pp. 486-499, 2017.
doi:10.1109/THMS.2017.2706727
[4] A. Kokosy, T. Floquet, G. Howells, H. Hu, M. Pepper, M. Sakel and
C. Donze, “SYSIASS - an intelligent powered wheelchair,” in
International Conference on Systems and Computer Science, Lille,
2012
[5] J. Leaman and H. M. La, “iChair: Intelligent powerchair for severely
disabled people,” in The ISSAT International Conference on
Modeling of Complex Systems and Environments (MCSE), Da Nang,
2015, pp. 1-6. doi:10.13140/RG.2.1.3404.0808
[6] U. Yayan, B. Akar, F. İnan and A. Yazici, “Development of indoor
navigation software for intelligent wheelchair,” in 22nd Signal
Processing and Communications Applications Conference (SIU),
Trabzon, 2014, pp. 405-408. doi:10.1109/SIU.2014.6830251
[7] E. Demeester, E. Vander Poorten, A. Hüntemann and J. De Schutter,
“Wheelchair navigation assistance in the fp7 project radhar:
Objectives and current state,” IROS 2012 Workshop on Progress,
Figure 28. Real wheelchair’s deflection angle representation on the Challenges and Future Perspectives in Navigation and Manipulation
sidewalk Assistance for Robotic Wheelchairs, 2012
13
[Downloaded from www.aece.ro on Saturday, July 06, 2024 at 04:13:07 (UTC) by 68.36.208.214. Redistribution subject to AECE license or copyright.]
[8] S. A. V. Kuppa, M. S. H. Reddy, A. Sanjana, J. Sridevi and V. U. [24] M. N. Yazar, Z. A. Erbudak, A. Bay, İ. Dost and A. Semiz, “Path
Rani, “Design and development of smart wheelchair,” in IEEE 2nd tracking methods employed in lane centering systems,” in 7th
International Conference on Sustainable Energy and Future Electric International Conference on Mechanical Engineering and Robotics
Transportation (SeFeT), Hyderabad, 2022, pp. 1-5. Research (ICMERR), Krakow, 2022, pp. 13-17.
doi:10.1109/SeFeT55524.2022.9908983 doi:10.1109/ICMERR56497.2022.10097807
[9] F. Pasteau, V. K. Narayanan, M. Babel and F. Chaumette, “A visual [25] J. Ni, Y. Wang, H. Li and H. Du, “Path tracking motion control
servoing approach for autonomous corridor following and doorway method of tracked robot based on improved LQR control,” in 41st
passing in a wheelchair,” Robotics and Autonomous Systems, 75, pp. Chinese Control Conference (CCC), Hefei, 2022, pp. 2888-2893.
28-40, 2016. doi:10.1016/j.robot.2014.10.017 doi:10.23919/CCC55666.2022.9902113
[10] F. Pasteau, M. Babel and R. Sekkal, “Corridor following wheelchair [26] E. V. Kumar and J. Jerome, “Robust LQR controller design for
by visual servoing,” in International Conference on Intelligent Robots stabilizing and trajectory tracking of inverted pendulum,” Procedia
and Systems (IEEE/RSJ), Tokyo, 2013, pp. 590-595. Engineering, 64, pp. 169-178, 2013.
doi:10.1109/IROS.2013.6696411 doi:10.1016/j.proeng.2013.09.088
[11] G. R. Shoovo, B. Dey, M. K. Akash, T. Motahara and M. H. Imam, [27] N. Razmjooy, A. Madadi, H. R. Alikhani and M. Mohseni,
“Design of a line following wheelchair for visually impaired “Comparison of LQR and pole placement design controllers for
paralyzed patient,” in 2nd International Conference on Robotics, controlling the inverted pendulum,” Journal of World’s Electrical
Electrical and Signal Processing Techniques (ICREST), Dhaka, 2021, Engineering and Technology, vol. 3(2), pp. 83-88, 2014
pp. 398-402. doi:10.1109/ICREST51555.2021.9331218 [28] S. C. Saini, Y. Sharma, M. Bhandari and U. Satija, “Comparison of
[12] H. İ. Şahin and A. R. Kavsaoğlu, “Autonomously controlled pole placement and LQR applied to single link flexible manipulator,”
intelligent wheelchair system for indoor areas,” in 3rd International in International Conference on Communication Systems and Network
Congress on Human-Computer Interaction, Optimization and Robotic Technologies (CSNT), Gujrat, 2012, pp.843-847.
Applications (HORA), Ankara, 2021, pp. 1-6. doi:10.1109/CSNT.2012.183
doi:10.1109/HORA52670.2021.9461335 [29] P. Chalupa, J. Trefil and J. Novák, “Modelling and hardware design
[13] Y. Du, N. J. Hetherington, C. L. Oon, W. P. Chan, C. P. Quintero, E. of double inverted pendulum,” in 24th International Conference on
Croft and H. M. Van der Loos, “Group surfing: A pedestrian-based Process Control (PC), Štrbské Pleso, 2023, pp. 18-23.
approach to sidewalk robot navigation,” in International Conference doi:10.1109/PC58330.2023.10217698
on Robotics and Automation (ICRA), Montreal, 2019, pp. 6518-6524. [30] S. Zarghoon and C. Belavý, “LQR and pole placement controllers
doi:10.1109/ICRA.2019.8793608 with integral action design technique and performance analysis for
[14] M. Wen, J. Zhang, T. Chen, G. Peng, T. Chia and Y. Ma, “Vision control of temperature field in continuous casting process,” in 24th
based sidewalk navigation for last-mile delivery robot,” in 17th International Carpathian Control Conference (ICCC), Miskolc-
International Conference on Control, Automation, Robotics and Szilvásvárad, 2023, pp. 489-494.
Vision (ICARCV), 2022, Singapore, pp. 249-254. doi:10.1109/ICCC57093.2023.10178886
doi:10.1109/ICARCV57592.2022.10004362 [31] B. N. Soufiani and M. A. Adli, “Pole placement and LQR control of
[15] T. Senlet and A. Elgammal, “Design of a vision-based autonomous slosh-free liquid transportation with dual-arm cooperative
robot for street navigation,” in 22nd Signal Processing and robot,” Journal of the Faculty of Engineering and Architecture of Gazi
Communications Applications Conference (SIU), Trabzon, 2014, pp. University, vol. 35(4), pp. 2255-2267, 2020.
862-865. doi:10.1109/SIU.2014.6830366 doi:10.17341/gazimmfd.703520
[16] M. Cheng, Y. Zhang, Y. Su, J. M. Alvarez and H. Kong, “Curb [32] P. V. C. Hough, “A method and means for recognizing complex
detection for road and sidewalk detection,” IEEE Transactions on patterns,” U.S. Patent No. 3069654, 1962
Vehicular Technology, 67(11), 10330-10342, Aug. 2018. [33] R. O. Duda and P. E. Hart, “Use of the Hough transformation to
doi:10.1109/TVT.2018.2865836 detect lines and curves in pictures,” Communications of the
[17] E. M. Araújo Filho and J. V. Da Fonseca Neto, “Optimal tuning of ACM, 15(1), pp. 11-15, 1972. doi:10.1145/361237.361242
dynamic controller via LQR in a powered wheelchair,” American [34] A. Alaa, E. Adel and A. Anwar, “Hough transform,”
Journal of Engineering Research, vol. 6(11), pp. 44-53, Nov. 2017 https://sbme-tutorials.github.io/2021/cv/notes/4_week4.html#original-
[18] S. Doung and U. Wasiwitono, “Multibody dynamics modeling and hough-transform-cartesian-coordinates (accessed Nov. 23, 2023)
control of wheelchair balancing system,” International Seminar on [35] H. Sun, Y. Liu, F. Li and X. Niu, “Distributed LQR optimal protocol
Intelligent Technology and Its Applications (ISITIA), Surabaya, 2021. for leader-following consensus,” IEEE Transactions on Cybernetics,
pp. 123-128. doi:10.1109/ISITIA52817.2021.9502215 vol. 49, pp. 3532-3546, July 2018. doi:10.1109/TCYB.2018.2850760
[19] W. C. Cheng and C. C. Chiang, “The development of the automatic [36] Y. Li, M. Xu, J. Chen and X. Wang, “Nonprobabilistic reliable LQR
lane following navigation system for the intelligent robotic design method for active vibration control of structures with
wheelchair,” in IEEE International Conference on Fuzzy Systems uncertainties,” AIAA Journal, Apr. 2018. doi:10.2514/1.J056510
(FUZZ-IEEE), Taipei, 2011, pp. 1946-1952. [37] L. Fan, P. Liu, H. Teng, G. Qiu, P. Jiang, “Design of LQR tracking
doi:10.1109/FUZZY.2011.6007742 controller combined with orthogonal collocation state planning for
[20] S. A. Wani, I. Nasiruddin, M. Shahid and S. Khatoon, “Intelligent process optimal control,” IEEE Access, vol. 8, Dec. 2020.
controller design for motion control of smart wheelchair,” in doi:10.1109/ACCESS.2020.3043498
International Conference on Power, Instrumentation, Energy and [38] S. Das, K. Halder and A. Gupta, “Delay handling method in
Control (PIECON), Aligarh, 2023, pp. 1-5. dominant pole placement based PID controller design,” IEEE
doi:10.1109/PIECON56912.2023.10085867 Transactions on Industrial Informatics, vol. 16, pp. 980-991, May,
[21] L. Wei and W. Yao, “Design and implement of LQR controller for a 2019. doi:10.1109/TII.2019.2918252
self-balancing unicycle robot,” in IEEE International Conference on [39] Y. Lan and M. Fei, “Design of state-feedback
Information and Automation (ICIA), Lijiang, 2015, pp. 169-173. controller by pole placement for a coupled set of inverted
doi:10.1109/ICInfA.2015.7279279 pendulums,” in 10th International Conference on
[22] I. Siradjuddin, Y. W. Syaifudin, T. Winarno, E. Rohadi, F. A. Electronic Measurement & Instruments (ICEMI), Chengdu, 2011, pp.
Salsabilla and S. Adhisuwignjo, “Linear controller design using pole 69-73. doi:10.1109/ICEMI.2011.6037857
placement method for nonholonomic mobile robot trajectory [40] G. F. Franklin, J. D. Powell, M. L. Workman, “Digital control of
tracking,” in Sixth International Conference on Vocational Education dynamic systems,” pp. 313-314, Addison-Wesley, 1998
and Electrical Engineering (ICVEE), Surabaya, 2023, pp. 122-126. [41] G. F. Franklin, J. D. Powell, A. Emami-Naeini, “Feedback control of
doi:10.1109/ICVEE59738.2023.10348262 dynamic systems,” pp. 477-480, Prentice Hall, 2002
[23] Y. Sun, Q. Dai, J. Liu, X. Zhao and H. Guo, “Intelligent vehicle path [42] H. Saadat, “Power System Analysis”, pp. 569-572, McGraw-Hill,
tracking based on feedback linearization and LOR under extreme 1993
conditions,” in 41st Chinese Control Conference (CCC), Hefei, 2022,
pp. 5383-5389. doi:10.23919/CCC55666.2022.9901797
14