C++11のLambda Functionsじゃダメなの?
いい加減、組み込みですらC++11は許される時代だと思うけど