OSDev.org

I have been switching away from text mode and have started using VGA 320x200x256 as the main screen. But while I was implementing drawing methods, this little bug showed itself.

I was going to just add one extra pixel to my rectangle method, but I could be looking over something way worse. Anyone have an idea of what is going on?
(VGA Driver Code)
https://pastebin.com/48MuAtJW

Missing a couple of -1's in rectangle().
Also incorrectly checking the ranges in setp(). Same problem: off by one.