2023WayOfTheRobot/src/main/java/frc4388/robot/Robot.java

/*----------------------------------------------------------------------------*/
/* Copyright (c) 2017-2019 FIRST. All Rights Reserved.                        */
/* Open Source Software - may be modified and shared by FRC teams. The code   */
/* must be accompanied by the FIRST BSD license file in the root directory of */
/* the project.                                                               */
/*----------------------------------------------------------------------------*/

package frc4388.robot;

import java.io.File;
import java.io.IOException;
import java.io.PrintWriter;

import edu.wpi.first.wpilibj.DriverStation;
import edu.wpi.first.wpilibj.TimedRobot;
import edu.wpi.first.wpilibj2.command.Command;
import edu.wpi.first.wpilibj2.command.CommandScheduler;
import frc4388.utility.RobotTime;

/**
 * The VM is configured to automatically run this class, and to call the
 * functions corresponding to each mode, as described in the TimedRobot
 * documentation. If you change the name of this class or the package after
 * creating this project, you must also update the build.gradle file in the
 * project.
 */
public class Robot extends TimedRobot {
  Command m_autonomousCommand;
  
  private RobotTime m_robotTime = RobotTime.getInstance();
  private RobotContainer m_robotContainer;


  /**
   * This function is run when the robot is first started up and should be
   * used for any initialization code.
   */
  @Override
  public void robotInit() {
    // Instantiate our RobotContainer.  This will perform all our button bindings, and put our
    // autonomous chooser on the dashboard.
    m_robotContainer = new RobotContainer();

    
  }

  /**
   * This function is called every robot packet, no matter the mode. Use
   * this for items like diagnostics that you want ran during disabled,
   * autonomous, teleoperated and test.
   *
   * <p>This runs after the mode specific periodic functions, but before
   * LiveWindow and SmartDashboard integrated updating.
   */
  @Override
  public void robotPeriodic() {
    m_robotTime.updateTimes();
    // Runs the Scheduler.  This is responsible for polling buttons, adding newly-scheduled
    // commands, running already-scheduled commands, removing finished or interrupted commands,
    // and running subsystem periodic() methods.  This must be called from the robot's periodic
    // block in order for anything in the Command-based framework to work.
    CommandScheduler.getInstance().run();
  }

  /**
   * This function is called once each time the robot enters Disabled mode.
   * You can use it to reset any subsystem information you want to clear when
   * the robot is disabled.
   */
  @Override
  public void disabledInit() {
    m_robotTime.endMatchTime();
  }

  @Override
  public void disabledPeriodic() {
  }

  /**
   * This autonomous runs the autonomous command selected by your {@link RobotContainer} class.
   */
  @Override
  public void autonomousInit() {
    m_robotContainer.m_robotSwerveDrive.resetGyro();
    m_autonomousCommand = m_robotContainer.getAutonomousCommand();

    // schedule the autonomous command (example)
    if (m_autonomousCommand != null) {
      m_autonomousCommand.schedule();
    }
    m_robotTime.startMatchTime();
  }

  /**
   * This function is called periodically during autonomous.
   */
  @Override
  public void autonomousPeriodic() {
  }

  @Override
  public void teleopInit() {
    m_robotContainer.m_robotSwerveDrive.resetGyro();

//     File auto = new File("/home/lvuser/BlueNearDriveToChargeStation.txt");

//     try (PrintWriter writer = new PrintWriter(auto)) {
//       writer.println(
// "0.0,0.0,0.0,0.0,0\n" +
// "0.0,0.0,0.0,0.0,0\n" +
// "0.0,0.0,0.0,0.0,20\n" +
// "0.0,0.0,0.0,0.0,40\n" +
// "0.0,0.0,0.0,0.0,60\n" +
// "0.0,0.0,0.0,0.0,79\n" +
// "0.0,0.0,0.0,0.0,99\n" +
// "0.0,0.0,0.0,0.0,119\n" +
// "0.0,0.0,0.0,0.0,139\n" +
// "0.0,0.0,0.0,0.0,160\n" +
// "0.0,0.0,0.0,0.0,180\n" +
// "0.0,0.0,0.0,0.0,200\n" +
// "0.0,0.0,0.0,0.0,220\n" +
// "0.0,0.0,0.0,0.0,239\n" +
// "0.0,0.0,0.0,0.0,260\n" +
// "0.0,0.0,0.0,0.0,280\n" +
// "0.0,0.0,0.0,0.0,300\n" +
// "0.0,0.0,0.0,0.0,319\n" +
// "0.0,0.0,0.0,0.0,340\n" +
// "0.0,0.0,0.0,0.0,360\n" +
// "0.0,0.0,0.0,0.0,379\n" +
// "0.0,0.0,0.0,0.0,399\n" +
// "0.0,0.0,0.0,0.0,419\n" +
// "0.0,0.0,0.0,0.0,440\n" +
// "0.0,0.0,0.0,0.0,459\n" +
// "0.0,-0.109375,0.0,0.0,479\n" +
// "0.0,-0.109375,0.0,0.0,499\n" +
// "0.0,-0.109375,0.0,0.0,520\n" +
// "0.0,-0.109375,0.0,0.0,540\n" +
// "0.0,-0.1171875,0.0,0.0,559\n" +
// "0.0,-0.1171875,0.0,0.0,580\n" +
// "0.0,-0.1171875,0.0,0.0,599\n" +
// "0.0,-0.1171875,0.0,0.0,621\n" +
// "0.0,-0.1171875,0.0,0.0,639\n" +
// "0.0,-0.1171875,0.0,0.0,661\n" +
// "0.0,-0.1171875,0.0,0.0,680\n" +
// "0.0,-0.1171875,0.0,0.0,699\n" +
// "0.0,-0.1171875,0.0,0.0,721\n" +
// "0.0,-0.1171875,0.0,0.0,769\n" +
// "0.0,-0.125,0.0,0.0,778\n" +
// "0.0,-0.1328125,0.0,0.0,790\n" +
// "0.0,-0.1328125,0.0,0.0,802\n" +
// "0.0,-0.1328125,0.0,0.0,820\n" +
// "0.0,-0.1328125,0.0,0.0,840\n" +
// "0.0,-0.1328125,0.0,0.0,860\n" +
// "0.0,-0.1328125,0.0,0.0,879\n" +
// "0.0,-0.140625,0.0,0.0,899\n" +
// "0.0,-0.171875,0.0,0.0,933\n" +
// "0.0,-0.1875,0.0,0.0,944\n" +
// "0.0,-0.1875,0.0,0.0,959\n" +
// "0.0,-0.203125,0.0,0.0,979\n" +
// "0.0,-0.203125,0.0,0.0,999\n" +
// "0.0,-0.203125,0.0,0.0,1019\n" +
// "0.0,-0.203125,0.0,0.0,1039\n" +
// "0.0,-0.203125,0.0,0.0,1059\n" +
// "0.0,-0.203125,0.0,0.0,1079\n" +
// "0.0,-0.2109375,0.0,0.0,1099\n" +
// "0.0,-0.2109375,0.0,0.0,1120\n" +
// "0.0,-0.2109375,0.0,0.0,1140\n" +
// "0.0,-0.21875,0.0,0.0,1159\n" +
// "0.0,-0.2109375,0.0,0.0,1180\n" +
// "0.0,-0.2265625,0.0,0.0,1199\n" +
// "0.0,-0.234375,0.0,0.0,1219\n" +
// "0.0,-0.234375,0.0,0.0,1239\n" +
// "0.0,-0.234375,0.0,0.0,1259\n" +
// "0.0,-0.2421875,0.0,0.0,1280\n" +
// "0.0,-0.2578125,0.0,0.0,1300\n" +
// "0.0,-0.296875,0.0,0.0,1320\n" +
// "0.0,-0.296875,0.0,0.0,1340\n" +
// "0.0,-0.3046875,0.0,0.0,1359\n" +
// "0.0,-0.3125,0.0,0.0,1379\n" +
// "0.0,-0.3125,0.0,0.0,1399\n" +
// "0.0,-0.3125,0.0,0.0,1419\n" +
// "0.0,-0.3203125,0.0,0.0,1442\n" +
// "0.0,-0.3203125,0.0,0.0,1460\n" +
// "0.0,-0.3203125,0.0,0.0,1479\n" +
// "0.0,-0.3203125,0.0,0.0,1499\n" +
// "0.0,-0.3203125,0.0,0.0,1520\n" +
// "0.0,-0.3203125,0.0,0.0,1540\n" +
// "0.0,-0.3203125,0.0,0.0,1560\n" +
// "0.0,-0.3203125,0.0,0.0,1579\n" +
// "0.0,-0.3203125,0.0,0.0,1599\n" +
// "0.0,-0.328125,0.0,0.0,1619\n" +
// "0.0,-0.34375,0.0,0.0,1640\n" +
// "0.0,-0.3515625,0.0,0.0,1659\n" +
// "0.0,-0.359375,0.0,0.0,1680\n" +
// "0.0,-0.359375,0.0,0.0,1699\n" +
// "0.0,-0.359375,0.0,0.0,1720\n" +
// "0.0,-0.359375,0.0,0.0,1739\n" +
// "0.0,-0.3671875,0.0,0.0,1759\n" +
// "0.0,-0.375,0.0,0.0,1780\n" +
// "0.0,-0.390625,0.0,0.0,1799\n" +
// "0.0,-0.4140625,0.0,0.0,1820\n" +
// "0.0,-0.421875,0.0,0.0,1839\n" +
// "0.0,-0.4296875,0.0,0.0,1859\n" +
// "0.0,-0.4296875,0.0,0.0,1879\n" +
// "0.0,-0.4296875,0.0,0.0,1900\n" +
// "0.0,-0.4296875,0.0,0.0,1919\n" +
// "0.0,-0.4296875,0.0,0.0,1939\n" +
// "0.0,-0.4296875,0.0,0.0,1959\n" +
// "0.0,-0.4296875,0.0,0.0,1979\n" +
// "0.0,-0.4296875,0.0,0.0,2000\n" +
// "0.0,-0.4296875,0.0,0.0,2019\n" +
// "0.0,-0.4296875,0.0,0.0,2039\n" +
// "0.0,-0.4296875,0.0,0.0,2060\n" +
// "0.0,-0.4296875,0.0,0.0,2080\n" +
// "0.0,-0.4296875,0.0,0.0,2099\n" +
// "0.0,-0.4296875,0.0,0.0,2119\n" +
// "0.0,-0.4296875,0.0,0.0,2139\n" +
// "0.0,-0.4296875,0.0,0.0,2160\n" +
// "0.0,-0.4375,0.0,0.0,2179\n" +
// "0.0,-0.4453125,0.0,0.0,2199\n" +
// "0.0,-0.453125,0.0,0.0,2220\n" +
// "0.0,-0.453125,0.0,0.0,2240\n" +
// "0.0,-0.453125,0.0,0.0,2260\n" +
// "0.0,-0.453125,0.0,0.0,2280\n" +
// "0.0,-0.453125,0.0,0.0,2300\n" +
// "0.0,-0.453125,0.0,0.0,2320\n" +
// "0.0,-0.453125,0.0,0.0,2340\n" +
// "0.0,-0.453125,0.0,0.0,2359\n" +
// "0.0,-0.453125,0.0,0.0,2379\n" +
// "0.0,-0.453125,0.0,0.0,2399\n" +
// "0.0,-0.453125,0.0,0.0,2419\n" +
// "0.0,-0.453125,0.0,0.0,2440\n" +
// "0.0,-0.453125,0.0,0.0,2460\n" +
// "0.0,-0.453125,0.0,0.0,2479\n" +
// "0.0,-0.453125,0.0,0.0,2500\n" +
// "0.0,-0.453125,0.0,0.0,2520\n" +
// "0.0,-0.453125,0.0,0.0,2540\n" +
// "0.0,-0.453125,0.0,0.0,2559\n" +
// "0.0,-0.453125,0.0,0.0,2579\n" +
// "0.0,-0.4609375,0.0,0.0,2600\n" +
// "0.0,-0.4609375,0.0,0.0,2620\n" +
// "0.0,-0.4609375,0.0,0.0,2641\n" +
// "0.0,-0.4609375,0.0,0.0,2660\n" +
// "0.0,-0.4609375,0.0,0.0,2679\n" +
// "0.0,-0.4609375,0.0,0.0,2700\n" +
// "0.0,-0.4609375,0.0,0.0,2720\n" +
// "0.0,-0.46875,0.0,0.0,2740\n" +
// "0.0,-0.46875,0.0,0.0,2759\n" +
// "0.0,-0.46875,0.0,0.0,2779\n" +
// "0.0,-0.46875,0.0,0.0,2799\n" +
// "0.0,-0.46875,0.0,0.0,2819\n" +
// "0.0,-0.46875,0.0,0.0,2839\n" +
// "0.0,-0.46875,0.0,0.0,2859\n" +
// "0.0,-0.4765625,0.0,0.0,2880\n" +
// "0.0,-0.5078125,0.0,0.0,2915\n" +
// "0.0,-0.515625,0.0,0.0,2933\n" +
// "0.0,-0.515625,0.0,0.0,2945\n" +
// "0.0,-0.5234375,0.0,0.0,2960\n" +
// "0.0,-0.5234375,0.0,0.0,2979\n" +
// "0.0,-0.5234375,0.0,0.0,2999\n" +
// "0.0,-0.5234375,0.0,0.0,3020\n" +
// "0.0,-0.5234375,0.0,0.0,3040\n" +
// "0.0,-0.5234375,0.0,0.0,3059\n" +
// "0.0,-0.5234375,0.0,0.0,3079\n" +
// "0.0,-0.5234375,0.0,0.0,3099\n" +
// "0.0,-0.5234375,0.0,0.0,3119\n" +
// "0.0,-0.5234375,0.0,0.0,3140\n" +
// "0.0,-0.5234375,0.0,0.0,3159\n" +
// "0.0,-0.5234375,0.0,0.0,3180\n" +
// "0.0,-0.5234375,0.0,0.0,3199\n" +
// "0.0,-0.5234375,0.0,0.0,3219\n" +
// "0.0,-0.5234375,0.0,0.0,3239\n" +
// "0.0,-0.5234375,0.0,0.0,3260\n" +
// "0.0,-0.5234375,0.0,0.0,3279\n" +
// "0.0,-0.5234375,0.0,0.0,3299\n" +
// "0.0,-0.5234375,0.0,0.0,3320\n" +
// "0.0,-0.5234375,0.0,0.0,3339\n" +
// "0.0,-0.5234375,0.0,0.0,3359\n" +
// "0.0,-0.5234375,0.0,0.0,3380\n" +
// "0.0,-0.5234375,0.0,0.0,3400\n" +
// "0.0,-0.5234375,0.0,0.0,3420\n" +
// "0.0,-0.5234375,0.0,0.0,3439\n" +
// "0.0,-0.5234375,0.0,0.0,3459\n" +
// "0.0,-0.5234375,0.0,0.0,3479\n" +
// "0.0,-0.5234375,0.0,0.0,3499\n" +
// "0.0,-0.5234375,0.0,0.0,3520\n" +
// "0.0,-0.5234375,0.0,0.0,3539\n" +
// "0.0,-0.5234375,0.0,0.0,3559\n" +
// "0.0,-0.5234375,0.0,0.0,3579\n" +
// "0.0,-0.5234375,0.0,0.0,3600\n" +
// "0.0,-0.5234375,0.0,0.0,3619\n" +
// "0.0,-0.5234375,0.0,0.0,3640\n" +
// "0.0,-0.5234375,0.0,0.0,3659\n" +
// "0.0,-0.5234375,0.0,0.0,3679\n" +
// "0.0,-0.5234375,0.0,0.0,3699\n" +
// "0.0,-0.5234375,0.0,0.0,3720\n" +
// "0.0,-0.5234375,0.0,0.0,3740\n" +
// "0.0,-0.5234375,0.0,0.0,3759\n" +
// "0.0,-0.5234375,0.0,0.0,3779\n" +
// "0.0,-0.5234375,0.0,0.0,3800\n" +
// "0.0,-0.5234375,0.0,0.0,3820\n" +
// "0.0,-0.5234375,0.0,0.0,3840\n" +
// "0.0,-0.5234375,0.0,0.0,3859\n" +
// "0.0,-0.5234375,0.0,0.0,3879\n" +
// "0.0,-0.5234375,0.0,0.0,3900\n" +
// "0.0,-0.5390625,0.0,0.0,3920\n" +
// "0.0,-0.546875,0.0,0.0,3939\n" +
// "0.0,-0.546875,0.0,0.0,3959\n" +
// "0.0,-0.546875,0.0,0.0,3979\n" +
// "0.0,-0.546875,0.0,0.0,3999\n" +
// "0.0,-0.546875,0.0,0.0,4019\n" +
// "0.0,-0.5546875,0.0,0.0,4039\n" +
// "0.0,-0.5546875,0.0,0.0,4059\n" +
// "0.0,-0.5546875,0.0,0.0,4079\n" +
// "0.0,-0.5546875,0.0,0.0,4134\n" +
// "0.0,-0.5546875,0.0,0.0,4147\n" +
// "0.0,-0.5546875,0.0,0.0,4157\n" +
// "0.0,-0.5546875,0.0,0.0,4170\n" +
// "0.0,-0.5546875,0.0,0.0,4185\n" +
// "0.0,-0.5546875,0.0,0.0,4199\n" +
// "0.0,-0.5546875,0.0,0.0,4219\n" +
// "0.0,-0.5546875,0.0,0.0,4240\n" +
// "-0.0234375,-0.5625,0.0,0.0,4259\n" +
// "-0.03125,-0.5625,0.0,0.0,4279\n" +
// "-0.03125,-0.5625,0.0,0.0,4300\n" +
// "-0.03125,-0.5625,0.0,0.0,4319\n" +
// "-0.03125,-0.5625,0.0,0.0,4339\n" +
// "-0.0234375,-0.5625,0.0,0.0,4360\n" +
// "-0.03125,-0.5625,0.0,0.0,4379\n" +
// "-0.03125,-0.5625,0.0,0.0,4399\n" +
// "-0.03125,-0.5625,0.0,0.0,4419\n" +
// "-0.03125,-0.5625,0.0,0.0,4440\n" +
// "-0.03125,-0.5625,0.0,0.0,4461\n" +
// "-0.0390625,-0.5625,0.0,0.0,4479\n" +
// "-0.046875,-0.5625,0.0,0.0,4499\n" +
// "-0.0546875,-0.5625,0.0,0.0,4520\n" +
// "-0.0625,-0.5625,0.0,0.0,4540\n" +
// "-0.0625,-0.5625,0.0,0.0,4561\n" +
// "-0.0546875,-0.5625,0.0,0.0,4581\n" +
// "-0.0546875,-0.5625,0.0,0.0,4600\n" +
// "-0.0546875,-0.5625,0.0,0.0,4620\n" +
// "-0.0546875,-0.546875,0.0,0.0,4639\n" +
// "-0.0546875,-0.546875,0.0,0.0,4659\n" +
// "-0.0546875,-0.484375,0.0,0.0,4680\n" +
// "-0.0546875,-0.4375,0.0,0.0,4700\n" +
// "-0.0546875,-0.390625,0.0,0.0,4720\n" +
// "-0.0546875,-0.3671875,0.0,0.0,4739\n" +
// "-0.0546875,-0.3359375,0.0,0.0,4759\n" +
// "-0.0546875,-0.3203125,0.0,0.0,4779\n" +
// "-0.0546875,-0.2734375,0.0,0.0,4800\n" +
// "0.0,0.0,0.0,0.0,4820\n" +
// "0.0,0.0,0.0,0.0,4840\n" +
// "0.0,0.0,0.0,0.0,4859\n" +
// "0.0,0.0,0.0,0.0,4879\n" +
// "0.0,0.0,0.0,0.0,4899\n" +
// "0.0,0.0,0.0,0.0,4919\n" +
// "0.0,0.0,0.0,0.0,4939\n" +
// "0.0,0.0,0.0,0.0,4960\n" +
// "0.0,0.0,0.0,0.0,4980\n" +
// "0.0,0.0,0.0,0.0,4999\n" +
// "0.0,0.0,0.0,0.0,5019\n" +
// "0.0,0.0,0.0,0.0,5040\n" +
// "0.0,0.0,0.0,0.0,5061\n" +
// "0.0,0.0,0.0,0.0,5079\n" +
// "0.0,0.0,0.0,0.0,5100\n" +
// "0.0,0.0,0.0,0.0,5119\n" +
// "0.0,0.0,0.0,0.0,5140\n" +
// "0.0,0.0,0.0,0.0,5159\n" +
// "0.0,0.0,0.0,0.0,5180\n" +
// "0.0,0.0,0.0,0.0,5199\n" +
// "0.0,0.0,0.0,0.0,5219\n" +
// "0.0,0.0,0.0,0.0,5239\n" +
// "0.0,0.0,0.0,0.0,5259\n" +
// "0.0,0.0,0.0,0.0,5280\n" +
// "0.0,0.0,0.0,0.0,5299\n" +
// "0.0,0.0,0.0,0.0,5319\n" +
// "0.0,0.0,0.0,0.0,5339\n" +
// "0.0,0.0,0.0,0.0,5360\n" +
// "0.0,0.0,0.0,0.0,5379\n" +
// "0.0,0.0,0.0,0.0,5399\n" +
// "0.0,0.0,0.0,0.0,5419\n" +
// "0.0,0.0,0.0,0.0,5439\n" +
// "0.0,0.0,0.0,0.0,5459\n" +
// "0.0,0.0,0.0,0.0,5480\n" +
// "0.0,0.0,0.0,0.0,5500\n" +
// "0.0,0.0,0.0,0.0,5519\n" +
// "0.0,0.0,0.0,0.0,5540\n" +
// "0.0,0.0,0.0,0.0,5559\n" +
// "0.0,0.0,0.0,0.0,5579\n" +
// "0.0,0.0,0.0,0.0,5599\n" +
// "0.0,0.0,0.0,0.0,5619\n" +
// "0.0,0.0,0.0,0.0,5639\n" +
// "0.0,0.0,0.0,0.0,5659\n" +
// "0.0,0.0,0.0,0.0,5680\n" +
// "0.0,0.0,0.0,0.0,5699\n" +
// "0.0,0.0,0.0,0.0,5721\n" +
// "0.0,0.0,0.0,0.0,5739\n" +
// "0.0,0.0,0.0,0.0,5760\n" +
// "0.0,0.0,0.0,0.0,5779\n" +
// "0.0,0.0,0.0,0.0,5800\n" +
// "0.0,0.0,0.0,0.0,5819\n" +
// "0.0,0.0,0.0,0.0,5839\n" +
// "0.0,0.0,0.0,0.0,5859\n" +
// "0.0,0.0,0.0,0.0,5879\n" +
// "0.0,0.0,0.0,0.0,5900\n" +
// "0.0,0.0,0.0,0.0,5920\n" +
// "0.0,0.0,0.0,0.0,5939\n" +
// "0.0,0.0,0.0,0.0,5959\n" +
// "0.0,0.0,0.0,0.0,5979\n" +
// "-0.03125,0.11811023950576782,0.0,0.0,5999\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6020\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6039\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6059\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6079\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6100\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6119\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6139\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6159\n" +
// "-0.03125,0.14173229038715363,0.0,0.0,6179\n" +
// "-0.03125,0.14960630238056183,0.0,0.0,6199\n" +
// "-0.03125,0.14960630238056183,0.0,0.0,6219\n" +
// "-0.03125,0.14960630238056183,0.0,0.0,6239\n" +
// "-0.03125,0.14960630238056183,0.0,0.0,6259\n" +
// "-0.03125,0.14960630238056183,0.0,0.0,6280\n" +
// "-0.03125,0.14960630238056183,0.0,0.0,6299\n" +
// "-0.03125,0.16535432636737823,0.0,0.0,6319\n" +
// "-0.03125,0.19685038924217224,0.0,0.0,6340\n" +
// "-0.03125,0.20472441613674164,0.0,0.0,6360\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6381\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6399\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6419\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6440\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6459\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6479\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6499\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6519\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6540\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6559\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6579\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6599\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6619\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6640\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6660\n" +
// "-0.03125,0.21259842813014984,0.0,0.0,6679\n" +
// "-0.03125,0.33070865273475647,0.0,0.0,6700\n" +
// "-0.03125,0.33070865273475647,0.0,0.0,6720\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6740\n" +
// "-0.03125,0.3779527544975281,0.0,0.0,6760\n" +
// "-0.03125,0.3779527544975281,0.0,0.0,6780\n" +
// "-0.03125,0.3779527544975281,0.0,0.0,6800\n" +
// "-0.03125,0.3779527544975281,0.0,0.0,6819\n" +
// "-0.03125,0.3779527544975281,0.0,0.0,6839\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6859\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6879\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6899\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6920\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6939\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6959\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6979\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,6999\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7019\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7039\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7060\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7080\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7100\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7119\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7139\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7159\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7180\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7199\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7220\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7239\n" +
// "-0.03125,0.3700787425041199,0.0,0.0,7260\n" +
// "-0.03125,0.36220473051071167,0.0,0.0,7279\n" +
// "-0.03125,0.34645670652389526,0.0,0.0,7299\n" +
// "0.0,0.33070865273475647,0.0,0.0,7319\n" +
// "0.0,0.33070865273475647,0.0,0.0,7339\n" +
// "0.0,0.3385826647281647,0.0,0.0,7359\n" +
// "0.0,0.3385826647281647,0.0,0.0,7379\n" +
// "0.0,0.3385826647281647,0.0,0.0,7399\n" +
// "0.0,0.3385826647281647,0.0,0.0,7419\n" +
// "0.0,0.3385826647281647,0.0,0.0,7440\n" +
// "0.0,0.33070865273475647,0.0,0.0,7460\n" +
// "0.0,0.31496062874794006,0.0,0.0,7479\n" +
// "0.0,0.31496062874794006,0.0,0.0,7499\n" +
// "0.0,0.29133859276771545,0.0,0.0,7519\n" +
// "0.0,0.24409449100494385,0.0,0.0,7540\n" +
// "0.0,0.24409449100494385,0.0,0.0,7559\n" +
// "0.0,0.24409449100494385,0.0,0.0,7580\n" +
// "0.0,0.24409449100494385,0.0,0.0,7600\n" +
// "0.0,0.24409449100494385,0.0,0.0,7619\n" +
// "0.0,0.24409449100494385,0.0,0.0,7639\n" +
// "0.0,0.24409449100494385,0.0,0.0,7660\n" +
// "0.0,0.24409449100494385,0.0,0.0,7679\n" +
// "0.0,0.24409449100494385,0.0,0.0,7700\n" +
// "0.0,0.25196850299835205,0.0,0.0,7720\n" +
// "0.0,0.33070865273475647,0.0,0.0,7740\n" +
// "0.0,0.3700787425041199,0.0,0.0,7760\n" +
// "0.0,0.4251968562602997,0.0,0.0,7780\n" +
// "0.0,0.4566929042339325,0.0,0.0,7800\n" +
// "0.0,0.4645669162273407,0.0,0.0,7820\n" +
// "0.0,0.4645669162273407,0.0,0.0,7839\n" +
// "0.0,0.4645669162273407,0.0,0.0,7859\n" +
// "0.0,0.4645669162273407,0.0,0.0,7880\n" +
// "0.0,0.4645669162273407,0.0,0.0,7899\n" +
// "0.0,0.4645669162273407,0.0,0.0,7920\n" +
// "0.0,0.4645669162273407,0.0,0.0,7939\n" +
// "0.0,0.4803149700164795,0.0,0.0,7960\n" +
// "0.0,0.5039370059967041,0.0,0.0,7980\n" +
// "-0.0078125,0.5433070659637451,0.0,0.0,7999\n" +
// "-0.0078125,0.5748031735420227,0.0,0.0,8019\n" +
// "-0.015625,0.5748031735420227,0.0,0.0,8039\n" +
// "-0.015625,0.5748031735420227,0.0,0.0,8059\n" +
// "-0.015625,0.5748031735420227,0.0,0.0,8080\n" +
// "-0.015625,0.5511810779571533,0.0,0.0,8099\n" +
// "-0.015625,0.5354330539703369,0.0,0.0,8119\n" +
// "-0.015625,0.5354330539703369,0.0,0.0,8139\n" +
// "-0.015625,0.5354330539703369,0.0,0.0,8159\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8180\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8199\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8220\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8239\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8259\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8279\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8299\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8319\n" +
// "-0.0078125,0.5354330539703369,0.0,0.0,8340\n" +
// "-0.0078125,0.5275590419769287,0.0,0.0,8359\n" +
// "-0.0078125,0.4803149700164795,0.0,0.0,8379\n" +
// "-0.0078125,0.4803149700164795,0.0,0.0,8399\n" +
// "-0.0078125,0.4803149700164795,0.0,0.0,8421\n" +
// "-0.0078125,0.4803149700164795,0.0,0.0,8440\n" +
// "-0.0078125,0.4803149700164795,0.0,0.0,8460\n" +
// "-0.0078125,0.4803149700164795,0.0,0.0,8479\n" +
// "0.0,0.4803149700164795,0.0,0.0,8499\n" +
// "0.0,0.4803149700164795,0.0,0.0,8520\n" +
// "0.0,0.4803149700164795,0.0,0.0,8540\n" +
// "0.0,0.4803149700164795,0.0,0.0,8559\n" +
// "0.0,0.4803149700164795,0.0,0.0,8579\n" +
// "0.0,0.4803149700164795,0.0,0.0,8600\n" +
// "0.0,0.4803149700164795,0.0,0.0,8619\n" +
// "0.0,0.4803149700164795,0.0,0.0,8639\n" +
// "0.0,0.4803149700164795,0.0,0.0,8659\n" +
// "0.0,0.4724409580230713,0.0,0.0,8679\n" +
// "0.0,0.4409448802471161,0.0,0.0,8699\n" +
// "0.0,0.4173228442668915,0.0,0.0,8719\n" +
// "0.0,0.4094488322734833,0.0,0.0,8739\n" +
// "0.0,0.4094488322734833,0.0,0.0,8759\n" +
// "0.0,0.4094488322734833,0.0,0.0,8779\n" +
// "0.015748031437397003,0.4094488322734833,0.0,0.0,8799\n" +
// "0.04724409431219101,0.4094488322734833,0.0,0.0,8820\n" +
// "0.07874015718698502,0.4094488322734833,0.0,0.0,8840\n" +
// "0.07874015718698502,0.4094488322734833,0.0,0.0,8859\n" +
// "0.07874015718698502,0.4094488322734833,0.0,0.0,8879\n" +
// "0.07874015718698502,0.4251968562602997,0.0,0.0,8899\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,8920\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,8939\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,8959\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,8980\n" +
// "0.05511811003088951,0.4488188922405243,0.0,0.0,8999\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9019\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9039\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9059\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9079\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9099\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9120\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9139\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9159\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9179\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9199\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9219\n" +
// "0.031496062874794006,0.4488188922405243,0.0,0.0,9239\n" +
// "0.04724409431219101,0.4488188922405243,0.0,0.0,9260\n" +
// "0.06299212574958801,0.4488188922405243,0.0,0.0,9279\n" +
// "0.06299212574958801,0.4488188922405243,0.0,0.0,9299\n" +
// "0.06299212574958801,0.4488188922405243,0.0,0.0,9319\n" +
// "0.06299212574958801,0.4488188922405243,0.0,0.0,9339\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9359\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9380\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9400\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9419\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9439\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9460\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9480\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9499\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9519\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9539\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9559\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9579\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9600\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9619\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9639\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9659\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9679\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9699\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9722\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9739\n" +
// "0.07874015718698502,0.4488188922405243,0.0,0.0,9759\n" +
// "0.08661417663097382,0.4488188922405243,0.0,0.0,9780\n" +
// "0.08661417663097382,0.4488188922405243,0.0,0.0,9800\n" +
// "0.11811023950576782,0.4488188922405243,0.0,0.0,9820\n" +
// "0.14173229038715363,0.4488188922405243,0.0,0.0,9839\n" +
// "0.16535432636737823,0.4488188922405243,0.0,0.0,9859\n" +
// "0.22834645211696625,0.4488188922405243,0.0,0.0,9879\n" +
// "0.23622047901153564,0.4488188922405243,0.0,0.0,9899\n" +
// "0.23622047901153564,0.4409448802471161,0.0,0.0,9919\n" +
// "0.25984251499176025,0.4094488322734833,0.0,0.0,9940\n" +
// "0.29921260476112366,0.3858267664909363,0.0,0.0,9959\n" +
// "0.31496062874794006,0.3779527544975281,0.0,0.0,9979\n" +
// "0.32283464074134827,0.3700787425041199,0.0,0.0,9999\n" +
// "0.32283464074134827,0.3700787425041199,0.0,0.0,10019\n" +
// "0.36220473051071167,0.33070865273475647,0.0,0.0,10039\n" +
// "0.3779527544975281,0.25984251499176025,0.0,0.0,10059\n" +
// "0.3937007784843445,0.21259842813014984,0.0,0.0,10081\n" +
// "0.3937007784843445,0.20472441613674164,0.0,0.0,10100\n" +
// "0.3937007784843445,0.20472441613674164,0.0,0.0,10124\n" +
// "0.3937007784843445,0.20472441613674164,0.0,0.0,10140\n" +
// "0.3937007784843445,0.18897637724876404,0.0,0.0,10159\n" +
// "0.3937007784843445,0.18897637724876404,0.0,0.0,10180\n" +
// "0.3937007784843445,0.16535432636737823,0.0,0.0,10199\n" +
// "0.3937007784843445,0.16535432636737823,0.0,0.0,10221\n" +
// "0.3937007784843445,0.17322835326194763,0.0,0.0,10239\n" +
// "0.3937007784843445,0.16535432636737823,0.0,0.0,10260\n" +
// "0.3937007784843445,0.14960630238056183,0.0,0.0,10279\n" +
// "0.3937007784843445,0.14960630238056183,0.0,0.0,10300\n" +
// "0.3937007784843445,0.14960630238056183,0.0,0.0,10319\n" +
// "0.3937007784843445,0.14960630238056183,0.0,0.0,10340\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10360\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10380\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10399\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10419\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10440\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10459\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10479\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10500\n" +
// "0.3937007784843445,0.14173229038715363,0.0,0.0,10519\n" +
// "0.4015747904777527,0.14173229038715363,0.0,0.0,10540\n" +
// "0.4173228442668915,0.14173229038715363,0.0,0.0,10559\n" +
// "0.4251968562602997,0.13385826349258423,0.0,0.0,10580\n" +
// "0.4251968562602997,0.12598425149917603,0.0,0.0,10600\n" +
// "0.4251968562602997,0.10236220806837082,0.0,0.0,10620\n" +
// "0.4251968562602997,0.10236220806837082,0.0,0.0,10639\n" +
// "0.4330708682537079,0.10236220806837082,0.0,0.0,10659\n" +
// "0.4409448802471161,0.10236220806837082,0.0,0.0,10680\n" +
// "0.4488188922405243,0.07086614519357681,0.0,0.0,10699\n" +
// "0.4566929042339325,0.023622047156095505,0.0,0.0,10719\n" +
// "0.4566929042339325,0.0,0.0,0.0,10739\n" +
// "0.4645669162273407,0.0,0.0,0.0,10760\n" +
// "0.4645669162273407,0.0,0.0,0.0,10779\n" +
// "0.4724409580230713,0.0,0.0,0.0,10800\n" +
// "0.4724409580230713,0.0,0.0,0.0,10819\n" +
// "0.4724409580230713,0.0,0.0,0.0,10839\n" +
// "0.4803149700164795,0.0,0.0,0.0,10860\n" +
// "0.4881889820098877,0.0,0.0,0.0,10879\n" +
// "0.5039370059967041,0.0,0.0,0.0,10899\n" +
// "0.5275590419769287,0.0,0.0,0.0,10919\n" +
// "0.5354330539703369,0.0,0.0,0.0,10940\n" +
// "0.5354330539703369,0.0,0.0,0.0,10960\n" +
// "0.5354330539703369,0.0,0.0,0.0,10979\n" +
// "0.5354330539703369,0.0,0.0,0.0,10999\n" +
// "0.5354330539703369,0.0,0.0,0.0,11020\n" +
// "0.5354330539703369,0.0,0.0,0.0,11039\n" +
// "0.5354330539703369,0.0,0.0,0.0,11059\n" +
// "0.5354330539703369,0.0,0.0,0.0,11079\n" +
// "0.5354330539703369,0.0,0.0,0.0,11099\n" +
// "0.5354330539703369,0.0,0.0,0.0,11119\n" +
// "0.5354330539703369,0.0,0.0,0.0,11140\n" +
// "0.5354330539703369,0.0,0.0,0.0,11159\n" +
// "0.5354330539703369,0.0,0.0,0.0,11179\n" +
// "0.5354330539703369,0.0,0.0,0.0,11200\n" +
// "0.5354330539703369,0.0,0.0,0.0,11219\n" +
// "0.5354330539703369,0.0,0.0,0.0,11239\n" +
// "0.5354330539703369,0.0,0.0,0.0,11260\n" +
// "0.5354330539703369,0.0,0.0,0.0,11279\n" +
// "0.5354330539703369,0.0,0.0,0.0,11299\n" +
// "0.5275590419769287,0.0,0.0,0.0,11319\n" +
// "0.5275590419769287,0.0,0.0,0.0,11339\n" +
// "0.5275590419769287,0.0,0.0,0.0,11360\n" +
// "0.5275590419769287,0.0,0.0,0.0,11379\n" +
// "0.5275590419769287,0.0,0.0,0.0,11399\n" +
// "0.5275590419769287,0.0,0.0,0.0,11419\n" +
// "0.5275590419769287,0.0,0.0,0.0,11440\n" +
// "0.5275590419769287,0.0,0.0,0.0,11459\n" +
// "0.5275590419769287,0.0,0.0,0.0,11479\n" +
// "0.5275590419769287,0.0,0.0,0.0,11500\n" +
// "0.5275590419769287,0.0,0.0,0.0,11519\n" +
// "0.5275590419769287,0.0,0.0,0.0,11539\n" +
// "0.5275590419769287,0.0,0.0,0.0,11559\n" +
// "0.5275590419769287,0.0,0.0,0.0,11579\n" +
// "0.5118110179901123,0.0,0.0,0.0,11599\n" +
// "0.5118110179901123,0.0,0.0,0.0,11620\n" +
// "0.5118110179901123,0.0,0.0,0.0,11640\n" +
// "0.5039370059967041,0.0,0.0,0.0,11660\n" +
// "0.4803149700164795,0.0,0.0,0.0,11679\n" +
// "0.4566929042339325,0.0,0.0,0.0,11699\n" +
// "0.4330708682537079,0.0,0.0,0.0,11720\n" +
// "0.4173228442668915,0.0,0.0,0.0,11739\n" +
// "0.4094488322734833,0.0,0.0,0.0,11760\n" +
// "0.4094488322734833,0.0,0.0,0.0,11780\n" +
// "0.4094488322734833,0.0,0.0,0.0,11800\n" +
// "0.4094488322734833,0.0,0.0,0.0,11819\n" +
// "0.4094488322734833,0.0,0.0,0.0,11840\n" +
// "0.3937007784843445,0.0,0.0,0.0,11859\n" +
// "0.25196850299835205,-0.0390625,0.0,0.0,11879\n" +
// "0.11811023950576782,-0.078125,0.0,0.0,11900\n" +
// "0.06299212574958801,-0.078125,0.0,0.0,11920\n" +
// "0.0,0.0,0.0,0.0,11939\n" +
// "0.0,0.0,0.0,0.0,11959\n" +
// "0.0,0.0,0.0,0.0,11979\n" +
// "0.0,0.0,0.0,0.0,12000\n" +
// "0.0,0.0,0.0,0.0,12019\n" +
// "0.0,0.0,0.0,0.0,12040\n" +
// "0.0,0.0,0.0,0.0,12060\n" +
// "0.0,0.0,0.0,0.0,12080\n" +
// "0.0,0.0,0.0,0.0,12099\n" +
// "0.0,0.0,0.0,0.0,12119\n" +
// "0.0,-0.1015625,0.0,0.0,12139\n" +
// "0.0,-0.1015625,0.0,0.0,12159\n" +
// "0.0,-0.109375,0.0,0.0,12179\n" +
// "0.0,-0.1171875,0.0,0.0,12199\n" +
// "0.0,-0.1171875,0.0,0.0,12219\n" +
// "0.0,-0.1171875,0.0,0.0,12240\n" +
// "0.0,-0.1328125,0.0,0.0,12259\n" +
// "0.0,-0.15625,0.0,0.0,12279\n" +
// "0.0,-0.1953125,0.0,0.0,12300\n" +
// "0.0,-0.21875,0.0,0.0,12319\n" +
// "0.0,-0.28125,0.0,0.0,12339\n" +
// "0.0,-0.296875,0.0,0.0,12360\n" +
// "0.0,-0.3046875,0.0,0.0,12379\n" +
// "0.0,-0.3125,0.0,0.0,12399\n" +
// "0.0,-0.3359375,0.0,0.0,12419\n" +
// "0.0,-0.3359375,0.0,0.0,12440\n" +
// "0.0,-0.328125,0.0,0.0,12459\n" +
// "0.0,-0.328125,0.0,0.0,12479\n" +
// "0.0,-0.328125,0.0,0.0,12499\n" +
// "0.0,-0.328125,0.0,0.0,12520\n" +
// "0.0,-0.328125,0.0,0.0,12539\n" +
// "0.0,-0.328125,0.0,0.0,12560\n" +
// "0.0,-0.328125,0.0,0.0,12580\n" +
// "0.0,-0.328125,0.0,0.0,12599\n" +
// "0.0,-0.328125,0.0,0.0,12620\n" +
// "0.0,-0.328125,0.0,0.0,12639\n" +
// "0.0,-0.328125,0.0,0.0,12659\n" +
// "0.0,-0.328125,0.0,0.0,12679\n" +
// "0.0,-0.328125,0.0,0.0,12699\n" +
// "0.0,-0.328125,0.0,0.0,12719\n" +
// "0.0,-0.328125,0.0,0.0,12739\n" +
// "0.0,-0.328125,0.0,0.0,12760\n" +
// "0.0,-0.34375,0.0,0.0,12780\n" +
// "0.0,-0.3515625,0.0,0.0,12799\n" +
// "0.0,-0.359375,0.0,0.0,12819\n" +
// "0.0,-0.359375,0.0,0.0,12840\n" +
// "0.0,-0.359375,0.0,0.0,12860\n" +
// "0.0,-0.359375,0.0,0.0,12880\n" +
// "0.0,-0.359375,0.0,0.0,12900\n" +
// "0.0,-0.3671875,0.0,0.0,12921\n" +
// "0.0,-0.3671875,0.0,0.0,12939\n" +
// "0.0,-0.375,0.0,0.0,12959\n" +
// "0.0,-0.375,0.0,0.0,12979\n" +
// "0.0,-0.390625,0.0,0.0,12999\n" +
// "0.015748031437397003,-0.40625,0.0,0.0,13019\n" +
// "0.023622047156095505,-0.421875,0.0,0.0,13039\n" +
// "0.03937007859349251,-0.4296875,0.0,0.0,13060\n" +
// "0.03937007859349251,-0.4296875,0.0,0.0,13079\n" +
// "0.04724409431219101,-0.453125,0.0,0.0,13099\n" +
// "0.05511811003088951,-0.46875,0.0,0.0,13119\n" +
// "0.05511811003088951,-0.484375,0.0,0.0,13139\n" +
// "0.05511811003088951,-0.5,0.0,0.0,13160\n" +
// "0.05511811003088951,-0.515625,0.0,0.0,13179\n" +
// "0.05511811003088951,-0.515625,0.0,0.0,13199\n" +
// "0.05511811003088951,-0.515625,0.0,0.0,13219\n" +
// "0.05511811003088951,-0.5234375,0.0,0.0,13239\n" +
// "0.05511811003088951,-0.5234375,0.0,0.0,13260\n" +
// "0.05511811003088951,-0.5234375,0.0,0.0,13279\n" +
// "0.05511811003088951,-0.5234375,0.0,0.0,13299\n" +
// "0.05511811003088951,-0.5234375,0.0,0.0,13319\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13339\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13359\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13379\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13400\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13419\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13439\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13459\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13479\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13499\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13519\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13539\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13559\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13579\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13599\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13620\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13642\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13659\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13679\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13699\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13720\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13740\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13760\n" +
// "0.04724409431219101,-0.5234375,0.0,0.0,13779\n" +
// "0.04724409431219101,-0.53125,0.0,0.0,13800\n" +
// "0.04724409431219101,-0.546875,0.0,0.0,13819\n" +
// "0.04724409431219101,-0.5625,0.0,0.0,13840\n" +
// "0.04724409431219101,-0.578125,0.0,0.0,13859\n" +
// "0.04724409431219101,-0.59375,0.0,0.0,13880\n" +
// "0.07874015718698502,-0.6875,0.0,0.0,13900\n" +
// "0.07874015718698502,-0.703125,0.0,0.0,13919\n" +
// "0.07874015718698502,-0.7265625,0.0,0.0,13944\n" +
// "0.07874015718698502,-0.7421875,0.0,0.0,13959\n" +
// "0.07874015718698502,-0.765625,0.0,0.0,13980\n" +
// "0.07874015718698502,-0.78125,0.0,0.0,14000\n" +
// "0.07874015718698502,-0.7890625,0.0,0.0,14020\n" +
// "0.07874015718698502,-0.8125,0.0,0.0,14039\n" +
// "0.07874015718698502,-0.8203125,0.0,0.0,14060\n" +
// "0.07874015718698502,-0.828125,0.0,0.0,14079\n" +
// "0.07874015718698502,-0.8359375,0.0,0.0,14099\n" +
// "0.07874015718698502,-0.8359375,0.0,0.0,14119\n" +
// "0.07874015718698502,-0.8359375,0.0,0.0,14139\n" +
// "0.07874015718698502,-0.8359375,0.0,0.0,14159\n" +
// "0.07874015718698502,-0.8359375,0.0,0.0,14179\n" +
// "0.07874015718698502,-0.8203125,0.0,0.0,14199\n" +
// "0.07874015718698502,-0.78125,0.0,0.0,14219\n" +
// "0.007874015718698502,-0.265625,0.0,0.0,14239\n" +
// "0.0,0.0,0.0,0.0,14259\n" +
// "0.0,0.0,0.0,0.0,14279\n" +
// "0.0,-0.1171875,0.0,0.0,14299\n" +
// "0.0,-0.1328125,0.0,0.0,14319\n" +
// "0.0,-0.171875,0.0,0.0,14339\n" +
// "0.0,-0.171875,0.0,0.0,14359\n" +
// "0.0,0.0,0.0,0.0,14379\n" +
// "0.0,0.0,0.0,0.0,14399\n" +
// "0.0,0.0,0.0,0.0,14419\n" +
// "0.0,0.0,0.0,0.0,14439\n" +
// "0.0,0.0,0.0,0.0,14459\n" +
// "0.0,0.0,0.0,0.0,14479\n" +
// "0.0,0.0,0.0,0.0,14499\n" +
// "0.0,0.0,0.0,0.0,14519\n" +
// "0.0,-0.203125,0.0,0.0,14539\n" +
// "0.0,-0.4609375,0.0,0.0,14559\n" +
// "0.031496062874794006,-0.71875,0.0,0.0,14579\n" +
// "0.031496062874794006,-0.9453125,0.0,0.0,14599\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14619\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14639\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14660\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14679\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14699\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14719\n" +
// "0.031496062874794006,-0.9609375,0.0,0.0,14739\n" +
// "0.031496062874794006,-0.9609375,0.0,0.0,14759\n" +
// "0.031496062874794006,-0.9609375,0.0,0.0,14780\n" +
// "0.031496062874794006,-0.9609375,0.0,0.0,14799\n" +
// "0.031496062874794006,-0.953125,0.0,0.0,14820\n" +
// "0.031496062874794006,-0.9609375,0.0,0.0,14839\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14860\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14880\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14900\n" +
// "0.03148045240972986,-0.999504367732367,0.0,0.0,14919\n" +
// "0.031496062874794006,-0.984375,0.0,0.0,14939\n" +
// "0.0,-0.3515625,0.0,0.0,14959\n" +
// "0.0,0.0,0.0,0.0,14980\n" +
// "0.0,0.0,0.0,0.0,14999\n" +
// "0.0,0.0,0.0,0.0,15019\n" +
// "0.0,0.0,0.0,0.0,15039\n" +
// "0.0,0.0,0.0,0.0,15059\n" +
// "0.0,0.0,0.0,0.0,15082\n" +
// "0.0,0.0,0.0,0.0,15099\n" +
// "0.0,0.0,0.0,0.0,15120\n"
//       );

//       writer.close();

//       System.out.println("Writing Done.");
//     } catch (IOException e) {
//         e.printStackTrace();
//     }

    // This makes sure that the autonomous stops running when
    // teleop starts running. If you want the autonomous to
    // continue until interrupted by another command, remove
    // this line or comment it out.
    if (m_autonomousCommand != null) {
      m_autonomousCommand.cancel();
    }
    m_robotContainer.m_robotSwerveDrive.resetGyro();
    m_robotTime.startMatchTime();
  }

  /**
   * This function is called periodically during operator control.
   */
  @Override
  public void teleopPeriodic() {
  }

  /**
   * This function is called periodically during test mode.
   */
  @Override
  public void testPeriodic() {
  }
}