https://arnoldpretoriusuct.github.io/Introduction-to-Robotics/Notes/HTML%20Exports/MEC4127F_Chapter6_WheeledRobotKinematics.html