00001 // Copyright (c) 2010-2016 The YP-Spur Authors, except where otherwise indicated. 00002 // 00003 // Permission is hereby granted, free of charge, to any person obtaining a copy 00004 // of this software and associated documentation files (the "Software"), to 00005 // deal in the Software without restriction, including without limitation the 00006 // rights to use, copy, modify, merge, publish, distribute, sublicense, and/or 00007 // sell copies of the Software, and to permit persons to whom the Software is 00008 // furnished to do so, subject to the following conditions: 00009 // 00010 // The above copyright notice and this permission notice shall be included in 00011 // all copies or substantial portions of the Software. 00012 // 00013 // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 00014 // IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 00015 // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 00016 // THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 00017 // LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 00018 // OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 00019 // SOFTWARE. 00020 00021 #ifndef __AUXLIB_ODOMETRY_SSM_H 00022 #define __AUXLIB_ODOMETRY_SSM_H 00023 00024 #ifdef __cplusplus 00025 extern "C" { 00026 #endif // __cplusplus 00027 00028 int OdometrySSM_init(void); 00029 int SSM_get_pos_GL_time(double time, double *x, double *y, double *theta); 00030 int SSM_get_pos_BS_time(double time, double *x, double *y, double *theta); 00031 double SSM_get_pos_GL(double *x, double *y, double *theta); 00032 double SSM_get_pos_BS(double *x, double *y, double *theta); 00033 double SSM_get_vel(double *v, double *w); 00034 int SSM_near_pos_GL(double x, double y, double r); 00035 int SSM_near_ang(double th, double d); 00036 int SSM_over_line(double x, double y, double theta); 00037 00038 #ifdef __cplusplus 00039 } 00040 #endif // __cplusplus 00041 #endif // __AUXLIB_ODOMETRY_SSM_H