This code is found on how to mechatronics (not mine, https://howtomechatronics.com/projects/diy-arduino-gimbal-self-stabilizing-platform/). I am working on an Arduino gimbal