Add main.py

This commit add the basic logic of the
algorithm without the succesors logic
This is hardcoded just for tests porpouses

Signed-off-by: vrodri3 <victor.manuel.rodriguez.bahena@intel.com>