Fix error in name of signal contactWrenchRightFoot. Modularize python test for estimator, add function for creating all ros topics.