Compiling sr_robot_lib tests. Not pasing though