Create hri.py

This file creates a sample environment with human and a robot