Valószínűleg nem a leggyorsabb és legoptimálisabb kód, ráadásul a Processing Python módjában van, de működik (legalábbis nem találtam esetet még, amire ne tenné).
https://pastebin.com/R7kxv6nZ

Először beállítom a koordinátákat úgy, hogy B pont mindkét értéke nagyobb nagy egyenlő legyen A pontéval. Ezután megnézem mi van akkor, ha a két pont megegyezik. Aztán megnézem az eseteket, amiknél az x vagy y koordináták megegyeznek (az y-t valószínűleg nem is kéne). Végül marad az általános eset.

EDIT:
Java megoldás: https://pastebin.com/xF35r73w
Életemben ezt a 20 percet javáztam, szóval ne várjon tőle senki sokat.