Reinforcement Learning for a Self-Balancing Motorcycle

Arduino Engineering Kit

Here is a video of the final project in action. <div class="se-component se-video-container __se__float-none" contenteditable="false" style="width: 100%;"><figure style="width: 100%; height: 56.25%; padding-bottom: 56.25%; margin: 0px;"><iframe frameborder="0" allowfullscreen="" src="https://www.youtube.com/embed/Oc6aTnIL8Uo" data-proportion="true" data-percentage="100%,56.25%" data-size="100%,56.25%" data-align="none" style="width: 100%; height: 100%;" data-index="0" data-file-size="0" data-origin="100%,56.25%"></iframe></figure></div>The motorcycle balances for about 10 -15 seconds, but further training and changing the incentives of the reward function can train it to balance longer.<h3 >How It All Started</h3>Balancing an <a href="https://www.mathworks.com/help/control/examples/control-of-an-inverted-pendulum-on-a-cart.html">inverted pendulum </a>is a ubiquitous example used in controls curricula, with lots of available solutions using concepts from <a href="https://en.wikipedia.org/wiki/PID_controller">PID control </a>or <a href="https://en.wikipedia.org/wiki/Reinforcement_learning">reinforcement learning.</a> Even though this was my first experience with reinforcement learning, I attempted a slightly different take on the classic inverted pendulum problem. I decided to use one of the robots from the <a href="https://www.mathworks.com/campaigns/products/arduino-kit.html">Arduino Engineering Kit:</a> a self-balancing motorcycle. In the motorcycle, an inertia wheel is used to balance the system instead of controlling the cart that pivots the pendulum. I wanted to apply the Q learning algorithm to the motorcycle instead of the classic cart pole problem because the motorcycle already had a high quality <a href="https://www.mathworks.com/products/simmechanics.html">Simscape </a>model available in the Kit. I used this to train and test different versions of algorithm. Although the model is an approximation and did not perfectly describe the motorcycle in real life, it was a great starting point before deploying to the actual hardware.<h3 >Background</h3>Reinforcement learning is the iterative process of an agent, learning to behave optimally in its environment by interacting with it. What this means is the way the agent learns to achieve a goal is by trying different actions in its environment and receiving positive or negative feedback, also called exploration. In the context of the self-balancing motorcycle, the agent is the motor controlling the inertia wheel. The way it interacts with its environment is by spinning the wheel at different speeds, and the feedback it receives is the new angular position and velocity, measured by an on-board IMU. Positive and negative feedback is determined by a unique reward function; I have elaborated on the reward function below.Here is a high-level diagram of the Q-learning iteration:<figure><img src=https://projects.arduinocontent.cc/3d9a074f-7f4a-4636-a4a3-373e0242191e.jpg /><figcaption> </figcaption></figure>Q learning (a fundamental reinforcement learning algorithm) follows this basic set of steps:1. Initialize a Q-matrix used for selecting optimal actions2. Get the current state of the system.3. Given the current state, select the corresponding action that maximizes the reward, or if you want to explore, to gain more environment feedback, select a random action.4. Find the new state, given that action, and execute the action.5. Calculate the reward, both immediate and discounted long-term reward.6. Update the Q-matrix using the calculated reward.7. Repeat from step 2Steps 4 – 6 occur in one time step of execution of the algorithm.The states that I used are the angular position (vector of length M) and angular velocity of the motorcycle (vector of length N). The actions are the torque commands (vector of length P). The Q matrix is an M x N x P vector that shows all possible states and every possible action at each state. The key is discretizing each space coarsely enough to capture the learning.<h3 >What Worked and What Did Not</h3>1. I implemented the basic algorithm for Q-learning in <a href="https://www.mathworks.com/products/simulink.html">Simulink </a>and <a href="https://www.mathworks.com/products/stateflow.html">Stateflow.</a> Stateflow was a particularly useful tool as it helped me model the discrete states of the Q-learning algorithm and incorporate both <a href="https://www.mathworks.com/products/matlab.html">MATLAB </a>and Simulink functions into the process. <figure><img src=https://projects.arduinocontent.cc/95d0a41c-8d89-48d1-9a73-005a9f1c201a.png /><figcaption> </figcaption></figure>2. In the first version of the algorithm, I tried a finely discretized set of actions (the torque commands to the motor), but the matrix was too large to upload to the Arduino. I made the action space and Q-matrix more coarsely discretized and used smaller data types, such as uint16 and int8 (where appropriate) to make the code just the right size to upload to an Arduino. I learned that the smaller data types were too small a representation to train the model accurately, so I had to find some other way to reduce the matrix size without sacrificing the fine representation of its values.3. Another factor I experimented with was the exploration time, which dictates the time for which the agent chooses a random action over the optimal action to learn from its environment. I used a function that decreased the probability of exploration as time increased, and I could manually set how long I want to explore. The probability is represented by the variable“ep” and the exploration time by 'expMin' in the Stateflow chart above. 4. I used the provided Simscape model (from <a href="https://www.mathworks.com/matlabcentral/fileexchange/66569-arduino_engineering_kit_project_files">this post</a>) so that there were no limitations on data type and size, and I could make the model smaller later. I used this model to determine the optimal learning parameters which were used in the training on the hardware. <figure><img src=https://projects.arduinocontent.cc/079620ae-061c-4c73-83a4-25c99fcc4762.png /><figcaption> </figcaption></figure>5. Before moving to the hardware, I had to reduce the size of the model further, so after considering other inverted pendulum controllers, I decided to go with a bang-bang (forward or reverse) controller for the smallest possible action space. This allowed me to use larger datatypes (floating point) to represent the Q-matrix.6. My first reward when training the hardware was the raw number of iterations through the algorithm, then I transitioned to the current reward function as the model improved. 7. My current reward function prefers low angular velocities, small angles, and quicker oscillations around the balance point. A penalty is applied when the robot falls.8. I changed the spacing of the state space fromevenly spaced to higher resolution around the balance point.9. I artificially increased the size action space by multiplying the bang-bang controller output by a factor that was dependent on how much the robot deviated from 0. Therefore, whatever the bang-bang controller output was then scaled up or down. These factors were found by trial and error and I found them to be 0.75 *angular position + 0.1 * angular velocity.10. My success criterion was when the robot balanced 10 seconds. However, after the goal was reached, I did not disable the training algorithm because continuing to train the model does not hurt its performance. Continuing to update the Q-matrix allows it to converge closer and closer to the optimal value. <h3 >Replication</h3>1. The Arduino Engineering Kit comes with three projects, one of which is the self-balancing motorcycle. The assembly instructions are available online with the kit. Follow the instructions provided with the Arduino Engineering Kit to download the required software to program the projects.2. Once the motorcycle is assembled, download the files available <a href="https://www.mathworks.com/matlabcentral/fileexchange/68396-reinforcement-learning-with-self-balancing-motorcycle">here</a> and open the RL_balance.slx model. Plug in the battery and power on the motor carrier. <figure><img src=https://projects.arduinocontent.cc/79b7ff07-0263-4e74-a56b-4692abf9324a.png /><figcaption> </figcaption></figure>3. Run the model. It will take a while for it to upload the first time you run it. 4. When it is running, calibrate the IMU by picking up the motorcycle and rotating it around all 3 principal axes. The “Calibration Status” display block should display 1.<figure><img src=https://projects.arduinocontent.cc/1b24ff61-f2e5-45ef-b99a-b25d8802ccc4.jpg /><figcaption> </figcaption></figure>5. In the scope block you will see measurements for theta, theta dot and the Torque Command. Manually attempt to balance the motorcycle, while visualizing on the theta scope where the balance point is. <figure><img src=https://projects.arduinocontent.cc/2492c5db-031a-4ad3-bfa5-4637a38f9561.png /><figcaption> </figcaption></figure>Then, use the Tilt Compensation slider to offset theta by that amount (this is inside the IMU Outputs block). <figure><img src=https://projects.arduinocontent.cc/dc126a1c-6b3b-4132-a25f-92fa2a67f797.png /><figcaption> </figcaption></figure>For example, if you see the physical balance point of the motorcycle is around theta = -0.5, you would move the tilt compensation slider to the right 0.5 to offset this error. <figure><img src=https://projects.arduinocontent.cc/d02113f5-a8e9-4926-801a-713f688c3ff0.png /><figcaption> </figcaption></figure>6. Once you have the physical balance point synced with theta = 0, then you can click the “isBal” rocker switch to indicate that the robot is balanced.<figure><img src=https://projects.arduinocontent.cc/7b7d353f-1551-45c3-a5e9-e58f3056a087.png /><figcaption> </figcaption></figure>7. Click the “held” rocker switch once to disable the training loop. Hold the motorcycle in an upright position close to theta = 0.<figure><img src=https://projects.arduinocontent.cc/bda443b6-56d2-4616-ab63-bacfa9abeced.png /><figcaption> </figcaption></figure>8. Click the held rocker switch to continue the loop, allow the motor to engage, and then release the motorcycle without pushing it in either direction.9. When the motorcycle falls, it is the end of that training. Repeat from step 7 to continue training. 10. Have patience. To put it in perspective, 15 hours of training went in to balancing for 10 seconds. 11. Some things you can try to better train the model would be increasing the resolution of the state and action spaces, initializing the Q matrix to something other than all zeros, and trying different reward functions that prefer different outcomes.12. The Q-learning algorithm “converges” when the goal (balancing 10 seconds) is reached. In other words, the Q -matrix does not appreciably change. Unlike neural networks where training is separate from deployment, Q-learning is model free, so deploying the algorithm is the same as training it. We can afford do this because there is low computational cost to training the Q-learning algorithm.<h3 >Useful Links:</h3>Medium: <a href="https://medium.freecodecamp.org/diving-deeper-into-reinforcement-learning-with-q-learning-c18d0db58efe">https://medium.freecodecamp.org/diving-deeper-into-reinforcement-learning-with-q-learning-c18d0db58efe </a>Mnemstudio: <a href="http://mnemstudio.org/path-finding-q-learning-tutorial.htm">http://mnemstudio.org/path-finding-q-learning-tutorial.htm </a>Why Q learning works: <a href="https://link.springer.com/content/pdf/10.1007%2FBF00992698.pdf">https://link.springer.com/content/pdf/10.1007%2FBF00992698.pdf </a>This is a little dense, but if you are interested, here is an introduction to reinforcement learning by the pioneers of the field: <a href="http://incompleteideas.net/book/bookdraft2017nov5.pdf">http://incompleteideas.net/book/bookdraft2017nov5.pdf </a>

Reinforcement Learning for a Self-Balancing Motorcycle

Machine learning does not have to be complicated models that cannot be deployed to MCUs, it could be a model-free learning algorithm.