C++ implementation of your code

Greetings
I have implemented code for testing in C++ opencv. Results are as good as your matlab implementation. My concern is that it consumes around 0.5sec per image in C++. I have used parallel programming at any step possible(for me). Can you please suggest some optimizations to make it fast?

PS :- I have also removed concatination of feats, cnodes from real time. I have concatinated then before i load the image. This resulted in decrease in computation time in real time but not as much i was expecting.

Thank You.