Merge fet, projecte funcionant,. Robot 1 modificat