2D model moved to a separarte lib
Added utils lib with some existing functionality
Robot model interface extended with ports and  sensors info