static void testH2()
{
H2 roboH2 = new H2();
roboH2.miOpen("MRX-H2");
roboH2.move(0, 0, 10, 100, 10);
float[] vals = roboH2.pose();
if (vals != null)
{
Console.WriteLine("{0},{1}", vals[0], vals[1]);
}
//string[] vals = roboH2.GetH2Posi();
//if (vals != null)
//{
// Console.WriteLine("{0},{1}", vals[0], vals[1]);
//}
}
