Started JNI cursed bs crashes for now

Signed-off-by: Jade Turner <[email protected]>

build.gradle

@@ -1,6 +1,8 @@
 plugins {
     id "java"
+    id "cpp"
     id "edu.wpi.first.GradleRIO" version "2025.1.1"
+    id 'edu.wpi.first.GradleJni' version '1.1.0'
     id "com.peterabeles.gversion" version "1.10"
     id "com.diffplug.spotless" version "6.12.0"
 }
@@ -12,6 +14,14 @@ java {
 
 def ROBOT_MAIN_CLASS = "org.curtinfrc.frc2025.Main"
 
+nativeUtils {
+    exportsConfigs {
+        // Only export explicit symbols from driver library
+        TrajgenJNI {
+        }
+    }
+}
+
 // Define my targets (RoboRIO) and artifacts (deployable files)
 // This is added by GradleRIO's backing project DeployUtils.
 deploy {
@@ -54,6 +64,46 @@ deploy {
     }
 }
 
+task refreshCompileCommands(type: Exec) {
+    workingDir = rootDir
+    def args = [
+        "rm",
+        "-rf",
+        "$buildDir/TargetedCompileCommands"
+    ]
+    commandLine args
+}
+
+model {
+    components {
+        TrajgenJNI(JniNativeLibrarySpec) {
+            targetPlatform wpi.platforms.desktop
+            enableCheckTask = true
+            javaCompileTasks << compileJava
+            jniCrossCompileOptions << JniCrossCompileOptions(wpi.platforms.desktop)
+
+            sources {
+                cpp {
+                    source {
+                        srcDirs 'src/main/native/cpp'
+                        include '**/*.cpp'
+                    }
+
+                    exportedHeaders {
+                        srcDir 'src/main/native/include'
+                    }
+                }
+            }
+
+            binaries.all {
+                lib project: ':trajoptlib', library: 'TrajoptLib', linkage: 'static'
+            }
+
+            nativeUtils.useRequiredLibrary(it, "wpilib_shared")
+        }
+    }
+}
+
 def deployArtifact = deploy.targets.roborio.artifacts.frcJava
 
 // Set to true to use debug for JNI.
@@ -88,6 +138,12 @@ task(regenerateTrajectories, dependsOn: "classes", type: Exec) {
 
 project.compileJava.finalizedBy(regenerateTrajectories)
 
+task(generateTrajectories, dependsOn: "classes", type: JavaExec) {
+    mainClass = "org.curtinfrc.frc2025.auto.TrajectoryGenerator"
+    classpath = sourceSets.main.runtimeClasspath
+    jvmArgs += "-Djava.library.path=${buildDir}/libs/trajgenJNI/shared/release"
+}
+
 // Defining my dependencies. In this case, WPILib (+ friends), and vendor libraries.
 // Also defines JUnit 4.
 dependencies {

src/main/java/org/curtinfrc/frc2025/BuildConstants.java

@@ -5,13 +5,13 @@ public final class BuildConstants {
   public static final String MAVEN_GROUP = "";
   public static final String MAVEN_NAME = "2025-Reefscape";
   public static final String VERSION = "unspecified";
-  public static final int GIT_REVISION = 31;
-  public static final String GIT_SHA = "49fcf1a927ffd856831b6830b5ea21b8ba9d1300";
-  public static final String GIT_DATE = "2025-01-19 00:50:01 AWST";
+  public static final int GIT_REVISION = 32;
+  public static final String GIT_SHA = "0f115e996864fe3a48167400e90c63b6f0f26404";
+  public static final String GIT_DATE = "2025-01-19 01:58:03 AWST";
   public static final String GIT_BRANCH = "jade/native-trajectory-bs";
-  public static final String BUILD_DATE = "2025-01-19 00:54:57 AWST";
-  public static final long BUILD_UNIX_TIME = 1737219297173L;
-  public static final int DIRTY = 1;
+  public static final String BUILD_DATE = "2025-01-19 02:01:27 AWST";
+  public static final long BUILD_UNIX_TIME = 1737223287612L;
+  public static final int DIRTY = 0;
 
   private BuildConstants() {}
 }

src/main/java/org/curtinfrc/frc2025/auto/TrajectoryGenerator.java

@@ -0,0 +1,7 @@
+package org.curtinfrc.frc2025.auto;
+
+public class TrajectoryGenerator {
+  public static void main(String... args) {
+    TrajgenJNI.helloWorld();
+  }
+}

src/main/java/org/curtinfrc/frc2025/auto/TrajgenJNI.java

@@ -0,0 +1,17 @@
+package org.curtinfrc.frc2025.auto;
+
+import edu.wpi.first.util.RuntimeLoader;
+import java.io.IOException;
+
+public class TrajgenJNI {
+  static {
+    try {
+      RuntimeLoader.loadLibrary("TrajgenJNI");
+    } catch (IOException e) {
+      e.printStackTrace();
+      System.exit(1);
+    }
+  }
+
+  public static native void helloWorld();
+}

src/main/native/cpp/TrajectoryGeneration.cpp

@@ -0,0 +1,12 @@
+#include "TrajectoryGeneration.h"
+#include "trajopt/SwerveTrajectoryGenerator.hpp"
+#include "trajopt/path/Path.hpp"
+#include <vector>
+
+trajopt::SwerveSolution trajgen::CreateInitialGuess(std::vector<trajopt::Waypoint> trajectory) {
+  return trajopt::SwerveSolution{};
+}
+
+trajopt::SwerveTrajectory trajgen::Generate(InputTrajectory trajectory) {
+  return trajopt::SwerveTrajectory{};
+}

src/main/native/cpp/TrajgenJNI.cpp

@@ -0,0 +1,20 @@
+#include <jni.h>
+#include <wpi/array.h>
+#include <wpi/jni_util.h>
+
+#include "fmt/base.h"
+#include "jni_md.h"
+
+extern "C" {
+/*
+ * Class:     frc_robot_jni_ShooterTrajoptJNI
+ * Method:    calculateTrajectory
+ * Signature: ([D????)V
+ */
+JNIEXPORT void JNICALL
+Java_org_curtinfrc_frc2025_auto_TrajgenJNI_helloWorld
+  (JNIEnv* env, jclass)
+{
+  fmt::println("Hello world!");
+}
+}  // extern "C"

src/main/native/include/TrajectoryGeneration.h

@@ -0,0 +1,16 @@
+#pragma once
+
+#include "trajopt/SwerveTrajectoryGenerator.hpp"
+#include "trajopt/constraint/Constraint.hpp"
+#include "trajopt/path/Path.hpp"
+#include <vector>
+
+namespace trajgen {
+struct InputTrajectory {
+  std::vector<trajopt::Waypoint> waypoints;
+  std::vector<trajopt::Constraint> constraints;
+};
+
+trajopt::SwerveSolution CreateInitialGuess(std::vector<trajopt::Waypoint> waypoints);
+trajopt::SwerveTrajectory Generate(InputTrajectory trajectory);
+}