Add toom-cook macro
Merge changes from Anders