Added simple AX servo test code