Got gyro input working. Need to PID it, it's not great.