mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
410 lines
11 KiB
C++
410 lines
11 KiB
C++
/*
|
|
Copyright (c) 2010-2016, Mathieu Labbe - IntRoLab - Universite de Sherbrooke
|
|
All rights reserved.
|
|
|
|
Redistribution and use in source and binary forms, with or without
|
|
modification, are permitted provided that the following conditions are met:
|
|
* Redistributions of source code must retain the above copyright
|
|
notice, this list of conditions and the following disclaimer.
|
|
* Redistributions in binary form must reproduce the above copyright
|
|
notice, this list of conditions and the following disclaimer in the
|
|
documentation and/or other materials provided with the distribution.
|
|
* Neither the name of the Universite de Sherbrooke nor the
|
|
names of its contributors may be used to endorse or promote products
|
|
derived from this software without specific prior written permission.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
|
|
ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
|
WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY
|
|
DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
|
ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#define GLM_FORCE_RADIANS
|
|
|
|
#include <jni.h>
|
|
#include <RTABMapApp.h>
|
|
#include <scene.h>
|
|
|
|
static RTABMapApp app;
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif
|
|
|
|
void GetJStringContent(JNIEnv *AEnv, jstring AStr, std::string &ARes) {
|
|
if (!AStr) {
|
|
ARes.clear();
|
|
return;
|
|
}
|
|
|
|
const char *s = AEnv->GetStringUTFChars(AStr,NULL);
|
|
ARes=s;
|
|
AEnv->ReleaseStringUTFChars(AStr,s);
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_onCreate(
|
|
JNIEnv* env, jobject, jobject activity)
|
|
{
|
|
return app.onCreate(env, activity);
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setScreenRotation(
|
|
JNIEnv* env, jobject, int displayRotation, int cameraRotation)
|
|
{
|
|
return app.setScreenRotation(displayRotation, cameraRotation);
|
|
}
|
|
|
|
JNIEXPORT int JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_openDatabase(
|
|
JNIEnv* env, jobject, jstring databasePath, bool databaseInMemory, bool optimize)
|
|
{
|
|
std::string databasePathC;
|
|
GetJStringContent(env,databasePath,databasePathC);
|
|
return app.openDatabase(databasePathC, databaseInMemory, optimize);
|
|
}
|
|
|
|
JNIEXPORT bool JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_onTangoServiceConnected(
|
|
JNIEnv* env, jobject, jobject iBinder) {
|
|
return app.onTangoServiceConnected(env, iBinder);
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_initGlContent(
|
|
JNIEnv*, jobject) {
|
|
app.InitializeGLContent();
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setupGraphic(
|
|
JNIEnv*, jobject, jint width, jint height) {
|
|
app.SetViewPort(width, height);
|
|
}
|
|
|
|
JNIEXPORT int JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_render(
|
|
JNIEnv*, jobject) {
|
|
return app.Render();
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_onPause(
|
|
JNIEnv*, jobject) {
|
|
app.onPause();
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setCamera(
|
|
JNIEnv*, jobject, int camera_index) {
|
|
using namespace tango_gl;
|
|
GestureCamera::CameraType cam_type =
|
|
static_cast<GestureCamera::CameraType>(camera_index);
|
|
app.SetCameraType(cam_type);
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_onTouchEvent(
|
|
JNIEnv*, jobject, int touch_count, int event, float x0, float y0, float x1,
|
|
float y1) {
|
|
using namespace tango_gl;
|
|
GestureCamera::TouchEvent touch_event =
|
|
static_cast<GestureCamera::TouchEvent>(event);
|
|
app.OnTouchEvent(touch_count, touch_event, x0, y0, x1, y1);
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setPausedMapping(
|
|
JNIEnv*, jobject, bool paused)
|
|
{
|
|
return app.setPausedMapping(paused);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setOnlineBlending(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setOnlineBlending(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMapCloudShown(
|
|
JNIEnv*, jobject, bool shown)
|
|
{
|
|
return app.setMapCloudShown(shown);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setOdomCloudShown(
|
|
JNIEnv*, jobject, bool shown)
|
|
{
|
|
return app.setOdomCloudShown(shown);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMeshRendering(
|
|
JNIEnv*, jobject, bool enabled, bool withTexture)
|
|
{
|
|
return app.setMeshRendering(enabled, withTexture);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setPointSize(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setPointSize(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setFOV(
|
|
JNIEnv*, jobject, float fov)
|
|
{
|
|
return app.setFOV(fov);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setOrthoCropFactor(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setOrthoCropFactor(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setLighting(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setLighting(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setBackfaceCulling(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setBackfaceCulling(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setWireframe(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setWireframe(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setLocalizationMode(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setLocalizationMode(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setTrajectoryMode(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setTrajectoryMode(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setGraphOptimization(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setGraphOptimization(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setNodesFiltering(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setNodesFiltering(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setGraphVisible(
|
|
JNIEnv*, jobject, bool visible)
|
|
{
|
|
return app.setGraphVisible(visible);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setGridVisible(
|
|
JNIEnv*, jobject, bool visible)
|
|
{
|
|
return app.setGridVisible(visible);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setRawScanSaved(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setRawScanSaved(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setFullResolution(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setFullResolution(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setSmoothing(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setSmoothing(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setCameraColor(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setCameraColor(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setAppendMode(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setAppendMode(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setDataRecorderMode(
|
|
JNIEnv*, jobject, bool enabled)
|
|
{
|
|
return app.setDataRecorderMode(enabled);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMaxCloudDepth(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setMaxCloudDepth(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMinCloudDepth(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setMinCloudDepth(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setCloudDensityLevel(
|
|
JNIEnv*, jobject, int value)
|
|
{
|
|
return app.setCloudDensityLevel(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMeshAngleTolerance(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setMeshAngleTolerance(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMeshTriangleSize(
|
|
JNIEnv*, jobject, int value)
|
|
{
|
|
return app.setMeshTriangleSize(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setClusterRatio(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setClusterRatio(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMaxGainRadius(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setMaxGainRadius(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setRenderingTextureDecimation(
|
|
JNIEnv*, jobject, int value)
|
|
{
|
|
return app.setRenderingTextureDecimation(value);
|
|
}
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setBackgroundColor(
|
|
JNIEnv*, jobject, float value)
|
|
{
|
|
return app.setBackgroundColor(value);
|
|
}
|
|
JNIEXPORT jint JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_setMappingParameter(
|
|
JNIEnv* env, jobject, jstring key, jstring value)
|
|
{
|
|
std::string keyC, valueC;
|
|
GetJStringContent(env,key,keyC);
|
|
GetJStringContent(env,value,valueC);
|
|
return app.setMappingParameter(keyC, valueC);
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_resetMapping(
|
|
JNIEnv*, jobject)
|
|
{
|
|
return app.resetMapping();
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_save(
|
|
JNIEnv* env, jobject, jstring databasePath)
|
|
{
|
|
std::string databasePathC;
|
|
GetJStringContent(env,databasePath,databasePathC);
|
|
return app.save(databasePathC);
|
|
}
|
|
|
|
JNIEXPORT void JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_cancelProcessing(
|
|
JNIEnv* env, jobject)
|
|
{
|
|
return app.cancelProcessing();
|
|
}
|
|
|
|
JNIEXPORT bool JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_exportMesh(
|
|
JNIEnv* env, jobject,
|
|
jstring filePath,
|
|
float cloudVoxelSize,
|
|
bool regenerateCloud,
|
|
bool meshing,
|
|
int textureSize,
|
|
int textureCount,
|
|
int normalK,
|
|
bool optimized,
|
|
float optimizedVoxelSize,
|
|
int optimizedDepth,
|
|
int optimizedMaxPolygons,
|
|
float optimizedColorRadius,
|
|
bool optimizedCleanWhitePolygons,
|
|
bool optimizedColorWhitePolygons,
|
|
float optimizedMaxTextureDistance,
|
|
int optimizedMinTextureClusterSize,
|
|
bool blockRendering)
|
|
{
|
|
std::string filePathC;
|
|
GetJStringContent(env,filePath,filePathC);
|
|
return app.exportMesh(
|
|
filePathC,
|
|
cloudVoxelSize,
|
|
regenerateCloud,
|
|
meshing,
|
|
textureSize,
|
|
textureCount,
|
|
normalK,
|
|
optimized,
|
|
optimizedVoxelSize,
|
|
optimizedDepth,
|
|
optimizedMaxPolygons,
|
|
optimizedColorRadius,
|
|
optimizedCleanWhitePolygons,
|
|
optimizedColorWhitePolygons,
|
|
optimizedMaxTextureDistance,
|
|
optimizedMinTextureClusterSize,
|
|
blockRendering);
|
|
}
|
|
|
|
JNIEXPORT bool JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_postExportation(
|
|
JNIEnv* env, jobject, bool visualize)
|
|
{
|
|
return app.postExportation(visualize);
|
|
}
|
|
|
|
JNIEXPORT int JNICALL
|
|
Java_com_introlab_rtabmap_RTABMapLib_postProcessing(
|
|
JNIEnv* env, jobject, int approach)
|
|
{
|
|
return app.postProcessing(approach);
|
|
}
|
|
|
|
|
|
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif
|