Added test firmware for running X and Y axes