Create StateEstimator1.py

First version