Standard headers and namespaces
Std namespaces
Added Orocos function