Advertisement
danh8569

MagnetometerCalibrationSimulation

Feb 13th, 2020
97
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 1.98 KB | None | 0 0
  1. public class sensor extends center {
  2.     double sensor_x;
  3.     double sensor_y;
  4.     double sensor_z;
  5.    
  6.     public sensor(double sensor_x, double sensor_y, double sensor_z) {
  7.         this.sensor_x = sensor_x;
  8.         this.sensor_y = sensor_y;
  9.         this.sensor_z = sensor_z;
  10.     }
  11.  
  12.     public double getSensor_x() {
  13.         return sensor_x;
  14.     }
  15.  
  16.     public void setSensor_x(double sensor_x) {
  17.         this.sensor_x = sensor_x;
  18.     }
  19.  
  20.     public double getSensor_y() {
  21.         return sensor_y;
  22.     }
  23.  
  24.     public void setSensor_y(double sensor_y) {
  25.         this.sensor_y = sensor_y;
  26.     }
  27.  
  28.     public double getSensor_z() {
  29.         return sensor_z;
  30.     }
  31.  
  32.     public void setSensor_z(double sensor_z) {
  33.         this.sensor_z = sensor_z;
  34.     }
  35. }
  36.  
  37. //sensor ^^^
  38.  
  39. public class hardiron {
  40.     double offset_x;
  41.     double offset_y;
  42.     double offset_z;
  43.     double corrected_x;
  44.     double corrected_y;
  45.     double corrected_z;
  46.    
  47.     public hardiron(double offset_x, double offset_y, double offset_z) {
  48.         this.offset_x = offset_x;
  49.         this.offset_y = offset_y;
  50.         this.offset_z = offset_z;
  51.     }
  52.    
  53.     public double getOffset_x(double max_x, double min_x) {
  54.         double offset_x = (max_x + min_x) / 2;
  55.         return offset_x;
  56.     }
  57.    
  58.     public double getOffset_y(double max_y, double min_y) {
  59.         double offset_y = (max_y + min_y) / 2;
  60.         return offset_y;
  61.     }
  62.    
  63.     public double getCorrected_x(double sensor_x, double offset_x) {
  64.         corrected_x = sensor_x - offset_x;
  65.         return corrected_x;
  66.     }
  67.    
  68.     public double getCorrected_y(double sensor_y, double offset_y) {
  69.         corrected_y = sensor_y - offset_y;
  70.         return corrected_y;
  71.     }
  72.     public double getCorrected_z(double sensor_z, double offset_z) {
  73.         corrected_z = sensor_z - offset_z;
  74.         return corrected_z;
  75.     }
  76.    
  77.     public double getOffset_z(double max_z, double min_z) {
  78.         double offset_z = (max_z + min_z) / 2;
  79.         return offset_z;
  80.     }
  81.  
  82. }
  83.  
  84. //hardiron ^^^
  85.  
  86. private static void printCorrectedxyz(double corrected_x, double corrected_y, double corrected_z) {
  87.         System.out.println("[" + corrected_x + ", " + corrected_y + ", " + corrected_z + "]");
  88.     }
  89.  
  90. //print some info ^^^
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement