Correction to the MatrixLoader function order to allow compilation on gcc-4.7+. Replaced orocos_kdl dependencies with the kdl_conversions in packages.
Added the identification node actionlib server. Started working on a petri-net based mission execution controller.