[xpi0t0s]

http://www.8085projects.info/Program41.html
Modifying it to do 16-bit should be easy enough if you've been paying attention in class.