Add finished p16.cpp