robotsim_dump();
//dump_cs("distance", &mainboard.distance.cs);
//dump_cs("angle", &mainboard.angle.cs);
robotsim_dump();
//dump_cs("distance", &mainboard.distance.cs);
//dump_cs("angle", &mainboard.angle.cs);
position_init(&mainboard.pos);
position_set_physical_params(&mainboard.pos, VIRTUAL_TRACK_MM, DIST_IMP_MM);
position_set_related_robot_system(&mainboard.pos, &mainboard.rs);
position_init(&mainboard.pos);
position_set_physical_params(&mainboard.pos, VIRTUAL_TRACK_MM, DIST_IMP_MM);
position_set_related_robot_system(&mainboard.pos, &mainboard.rs);