add startup statemachine, first setpoint plannings, add parameters