Fork of http://devel.iri.upc.edu/pub/labrobotica/drivers/epos2_motor_controller/trunk