Monor changes - preparing for  Inverted pendulum work