Add program mptidy.cpp and support functions
Update programs folder