2021-1-capstone-design2 / 2014104077

Go to a project
Toggle navigation Toggle navigation pinning
Wonseok Kwak
4d0089ec 1 parent 99a4012d

Update : IMU Serial logging 및 monitoring을 위한 소스

Inline Side-by-side
Showing 1 changed file with 9 additions and 11 deletions
......@@ -4,13 +4,9 @@ import math
ac_x = 0
ac_y = 0
ac_z = 0
normal_x = 0
normal_y = 0
normal_z = 0
deltha_x = [0,0,0]
deltha_y = [0,0,0]
deltha_z = [0,0,0]
deltha = 0
def map(x,input_min,input_max,output_min,output_max):
return (x-input_min)*(output_max-output_min)/(input_max-input_min)+output_min
......@@ -31,8 +27,6 @@ def main():
deltha_x[i] = 0
deltha_y[i] = 0
deltha_z[i] = 0
angle = 0
angle_value = 0
......@@ -45,9 +39,11 @@ def main():
ac_y = acceleration.Y
ac_z = acceleration.Z
normal_x = map(ac_x, -32768,32767,-5000,5000)
normal_y = map(ac_y, -32768,32767,-5000,5000)
normal_x = map(ac_x, -32768,32767,-10000,10000)
normal_y = map(ac_y, -32768,32767,-10000,10000)
normal_z = map(ac_z, -32768,32767,-5000,5000)
deltha_x[1] = deltha_x[1]+(normal_x)
deltha_y[1] = deltha_y[1]+(normal_y)
deltha_z[1] = deltha_z[1]+(normal_z)
......@@ -67,9 +63,11 @@ def main():
ac_y = acceleration.Y
ac_z = acceleration.Z
normal_x = map(ac_x, -32768,32767,-5000,5000)
normal_y = map(ac_y, -32768,32767,-5000,5000)
normal_x = map(ac_x, -32768,32767,-10000,10000)
normal_y = map(ac_y, -32768,32767,-10000,10000)
normal_z = map(ac_z, -32768,32767,-5000,5000)
deltha_x[2] = deltha_x[2]+(normal_x)
deltha_y[2] = deltha_y[2]+(normal_y)
deltha_z[2] = deltha_z[2]+(normal_z)
......@@ -82,7 +80,7 @@ def main():
deltha_y[0] = abs(deltha_y[1]-deltha_y[2])
deltha_z[0] = abs(deltha_z[1]-deltha_z[2])
deltha = deltha_x[0] + deltha_y[0] + deltha_z[0]
print("AcX : ", deltha_x[0], "AcY : ", deltha_y[0], "AcZ : ", deltha_z[0] - 230, "Total : ", deltha)
print("AcX : ", deltha_x[0], "AcY : ", deltha_y[0], "AcZ : ", deltha_z[0], "Total : ", deltha)
if __name__ == '__main__':
......