Faster control loop, more derivative term to help limit overcorrection,

error handling