Upper limb teleoperated control interface for powered ...

11
Master’s Final Thesis Master in Automatic Control and Robotics Upper limb teleoperated control interface for powered wheelchair users ANNEX 1 Autor: Carlos Gil Delgado Director: Jesús de Miguel Fernández Co-Director: Josep Maria Font Llagunes Announcement: June 2021

Transcript of Upper limb teleoperated control interface for powered ...

Page 1: Upper limb teleoperated control interface for powered ...

Master’s Final Thesis

Master in Automatic Control and Robotics

Upper limb teleoperated control interface forpowered wheelchair users

ANNEX 1

Autor: Carlos Gil DelgadoDirector: Jesús de Miguel FernándezCo-Director: Josep Maria Font LlagunesAnnouncement: June 2021

Page 2: Upper limb teleoperated control interface for powered ...

Page 2 Annex 1

Page 3: Upper limb teleoperated control interface for powered ...

Upper limb teleoperated control interface for powered wheelchair users Page 3

List of figures

Figure 1. Comparison between hardware control systems 5

Figure 2. Schematic of the MOVit wheelchair control system 6

Figure 3. MOVit control SolidWorks design 7

Figure 4. a) GripAble attachment SolidWork design. b) Physical appearance 7

Figure 5. Block diagram of the MOVit program of the wheelchair 9

Figure 6. Block diagram of the joystick program of the wheelchair 10

Page 4: Upper limb teleoperated control interface for powered ...

Page 4 Annex 1

Index

List of figures 3A1. 1. MOVit control hardware 6A1. 2. MOVit control modes 8

A1. 2. 1. MOVit control mode 8A1. 2. 2. Joystick control mode 9

Bibliography 11

Page 5: Upper limb teleoperated control interface for powered ...

Upper limb teleoperated control interface for powered wheelchair users Page 5

Annex 1. MOVit wheelchair with raspberry picontrolled using GripAble devices

To extrapolate the control of the car explained to the MOVit wheelchair it is necessary tochange the control signals of the programs because it uses a R-net Omni device to controlthe wheelchair motors, it is necessary to connect a D-sub 9 wire with specific signals [1].

The control is done with two signals, the “speed” determines if the wheelchair movesforward or backward and the “direction” signal determines the distribution of velocitybetween the right and left wheels to move in a straight line or turn. The objective is tosubstitute the actual hardware control system shown in Figure 1 surrounded by the redsquare by the new one developed based on the Raspberry Pi 4B surrounded by the greensquare. This new control system would reduce the energy consumption of the batteriesand increase the portability of the system due to the compatibility with other poweredwheelchairs.

Figure 1. Comparison between hardware control systems.

Page 6: Upper limb teleoperated control interface for powered ...

Page 6 Annex 1

A1. 1. MOVit control hardware

The power source of the Raspberry Pi are the batteries of the wheelchair, to connect tothem it is necessary to incorporate a DC-DC Buck Converter ANGEEK with usb output.The switch HEESCHEN controls the energy supply of the Raspberry and also the driverHl298N which is powered with 9 V reduced with a MAGT Buck Converter. The driversignals are similar to the MOVit Lite control having small differences due to it not being thesame driver, this one has to enable signals one for each motor output.

To send the control signals to the wheelchair R-net Omni controller is used a D'Sub9 wire,this device is used for security reasons to not access directly to the motors, the red cableis connected to the direction pin which determines the wheelchair turn. The yellow cable isconnected to the speed signal which determines the wheelchair direction. From the violetwire are supplied 12 V from the Omni controller and it is necessary to reduce to 6 V withanother MAGT Buck Converter to be sent again to the Omni controller as reference usingthe blue cable. All these connections mentioned are presented in the schematic attachedin Figure 2.

Figure 2. Schematic of the MOVit wheelchair control system.

Page 7: Upper limb teleoperated control interface for powered ...

Upper limb teleoperated control interface for powered wheelchair users Page 7

In order to protect the schematic previously commented and to attach it to the back of thewheelchair substituting the actual hardware, is designed a piece in SolidWorks whichenglobes all the components as it is observable in Figure 3. In this figure is also presentedthe physical appearance with all the components.

Figure 3. a) MOVit control SolidWorks design.b)and c) Physical appearance.

In order to attach the GripAble devices to the arms of the MOVit wheelchair it is necessaryto print some attachment pieces shown in Figure 4 the SolidWorks design on the left andthe physical appearance on the right.

Figure 4. a) GripAble attachment SolidWork design. b) Physical appearance.

Page 8: Upper limb teleoperated control interface for powered ...

Page 8 Annex 1

A1. 2. MOVit control modes

The control programs of the MOVit wheelchair follow the same structure as the MOVitLite, with the same two exercises implying the same muscles, the difference is located inthe control signals. As it was commented that the speed and direction depend on theirvalues respect the reference signal of 6 V. If the speed value is higher than the referencethe chair starts moving forward and if it lower backwards. This performance is the samewith the direction signal, if the direction value is higher than the reference it turns right if itis lower turn left [1]. The maximum values are 7,2 V and the minimum 4,8 V.

The complete codes are uploaded as the MOVit Lite ones in the github repository [2], inthe next section the programs are commented and it is shown the block diagram with themain behaviour of the systems.

A1. 2. 1. MOVit control mode

As it was explained the control of the MOVit Lite the muscles implied in this exercise areDeltoideus Anterior and Posterior, Teres Major and Triceps. In order to keep thewheelchair without movement it is required to send the same voltage as the reference one(6 V). To compute the control signals is used the accelerations of both GripAble devicesand then is transformed between 0 and 1,2 V which is the range of voltage accepted bythe Omni wheelchair controller datasheet [1].

If the wheelchair is in forward direction the mean value of both GripAble accelerations isadded to the reference value and it is subtracted in the backward movement. The directioncontrol has the same architecture, Figure 5 shows the block diagram of this program.

Page 9: Upper limb teleoperated control interface for powered ...

Upper limb teleoperated control interface for powered wheelchair users Page 9

Figure 5. Block diagram of the MOVit program of the wheelchair.

A1. 2. 2. Joystick control mode

The joystick program of the wheelchair follows the same behaviour as the MOVit Litebeing the muscles implied in this exercise are the forearm ones. The difference with theMOVit Lite program is presented in the control signals, the vertical inclination determinesthe voltage to send to the speed signal and the horizontal one the direction. To make thewheelchair spin in place it is necessary to bend the GripAble perpendicularly to the right orleft avoiding inclination to the front or back. Figure 6 shows the block diagram of thisprogram.

Page 10: Upper limb teleoperated control interface for powered ...

Page 10 Annex 1

Figure 6. Block diagram of the joystick program of the wheelchair.

Page 11: Upper limb teleoperated control interface for powered ...

Upper limb teleoperated control interface for powered wheelchair users Page 11

Bibliography

[1]: PG Drives Technology, (2011). R-net Omni datasheet. [Online], Available:http://sunrise.pgdrivestechnology.com/manuals/pgdt_omni_manual_SK78813-07.pdf

[2]: C. (2021, June 1). carlosgd96/TFM_Carlos_Gil_Delgado. GitHub. https://github.com/carlosgd96/TFM_Carlos_Gil_Delgado