Final asynchronous motor controller script. Just needs to adjust gains now :)