Fixed the ethercat slaves, and balance statemachine.
Working copy for implementing the packml status.