Create StateEstimator2.py

Mathematical optimization - less dictionary accesses