Moved original FSM code to a subfolder called 'classdef implementation'. Will add CPP code soon.
Moved StateMachineDemo to a subfolder of Caster FSM called StateMachineDemo (old)