Coordinating Robotic Tasks and Systems with rFSM Statecharts