Advertisement
danh8569

MagnetometerCalibrationSimulation_2

Feb 20th, 2020
128
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 3.48 KB | None | 0 0
  1. import java.util.*;
  2.  
  3. public class center {
  4.  
  5.     public static void main(String[] args) {
  6.         printSensorxyz(sensor.getSensor_x(), sensor.getSensor_y(), sensor.getSensor_z());
  7.         printOffsetxyz(hardiron.getOffset_x(100, 0), hardiron.getOffset_y(100, 0), hardiron.getOffset_z(100, 0));
  8.         printCorrectedxyz(hardiron.getCorrected_x(sensor.getSensor_x(), hardiron.getOffset_x(100, 0)),
  9.                 hardiron.getCorrected_y(sensor.getSensor_y(), hardiron.getOffset_y(100, 0)),
  10.                 hardiron.getCorrected_z(sensor.getSensor_z(), hardiron.getOffset_z(100, 0)));
  11.     }
  12.    
  13.     private static void printSensorxyz(double sensor_x, double sensor_y, double sensor_z) {
  14.         System.out.println("Sensor Info: [" + sensor_x + ", " + sensor_y + ", " + sensor_z + "]");
  15.     }
  16.    
  17.     private static void printOffsetxyz(double offset_x, double offset_y, double offset_z) {
  18.         System.out.println("Offset: [" + offset_x + ", " + offset_y + ", " + offset_z + "]");
  19.     }
  20.    
  21.     private static void printCorrectedxyz(double corrected_x, double corrected_y, double corrected_z) {
  22.         System.out.println("Corrected: [" + corrected_x + ", " + corrected_y + ", " + corrected_z + "]");
  23.     }
  24.    
  25. }
  26.  
  27. //center ^^^
  28.  
  29. import java.util.*;
  30.  
  31. public class sensor extends center {
  32.     static Random rnd = new Random();
  33.     static double sensor_x = rnd.nextDouble()*1000;
  34.     static double sensor_y = rnd.nextDouble()*1000;
  35.     static double sensor_z = rnd.nextDouble()*1000;
  36.    
  37.     public sensor(double sensor_x, double sensor_y, double sensor_z) {
  38.         this.sensor_x = sensor_x;
  39.         this.sensor_y = sensor_y;
  40.         this.sensor_z = sensor_z;
  41.     }
  42.  
  43.     public static double getSensor_x() {
  44.         return sensor_x;
  45.     }
  46.  
  47.     public void setSensor_x(double sensor_x) {
  48.         this.sensor_x = sensor_x;
  49.     }
  50.  
  51.     public static double getSensor_y() {
  52.         return sensor_y;
  53.     }
  54.  
  55.     public void setSensor_y(double sensor_y) {
  56.         this.sensor_y = sensor_y;
  57.     }
  58.  
  59.     public static double getSensor_z() {
  60.         return sensor_z;
  61.     }
  62.  
  63.     public void setSensor_z(double sensor_z) {
  64.         this.sensor_z = sensor_z;
  65.     }
  66. }
  67.  
  68. //sensor ^^^
  69.  
  70. public class hardiron {
  71.     static double offset_x = 0;
  72.     static double offset_y = 0;
  73.     static double offset_z = 0;
  74.     static double corrected_x = 0;
  75.     static double corrected_y = 0;
  76.     static double corrected_z = 0;
  77.    
  78.     public hardiron(double offset_x, double offset_y, double offset_z) {
  79.         this.offset_x = offset_x;
  80.         this.offset_y = offset_y;
  81.         this.offset_z = offset_z;
  82.     }
  83.    
  84.     public hardiron() {}
  85.    
  86.     public static double getOffset_x(double max_x, double min_x) {
  87.         double offset_x = (max_x + min_x) / 2;
  88.         return offset_x;
  89.     }
  90.    
  91.     public static double getOffset_y(double max_y, double min_y) {
  92.         double offset_y = (max_y + min_y) / 2;
  93.         return offset_y;
  94.     }
  95.    
  96.     public static double getOffset_z(double max_z, double min_z) {
  97.         double offset_z = (max_z + min_z) / 2;
  98.         return offset_z;
  99.     }
  100.    
  101.     public static double getCorrected_x(double sensor_x, double offset_x) {
  102.         corrected_x = sensor_x - offset_x;
  103.         return corrected_x;
  104.     }
  105.    
  106.     public static double getCorrected_y(double sensor_y, double offset_y) {
  107.         corrected_y = sensor_y - offset_y;
  108.         return corrected_y;
  109.     }
  110.     public static double getCorrected_z(double sensor_z, double offset_z) {
  111.         corrected_z = sensor_z - offset_z;
  112.         return corrected_z;
  113.     }
  114.  
  115. }
  116.  
  117. //hardiron ^^^
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement