Found a huge problem with the pid code, adding a sketch for what I'd imagine a lift off sequence would look like.