Acceleration Magnitude

Lab 2: คำนวณ Acceleration Magnitude

วัตถุประสงค์

• เพิ่มฟังก์ชัน calculate_magnitude() เข้าไปใน sensor_hub_daq_task.c

• เข้าใจการคำนวณขนาดของ vector

2.1 Concept: Vector Magnitude

$$\text{magnitude} = \sqrt{x^2 + y^2 + z^2}$$

เมื่อวางราบ:

• x ≈ 0, y ≈ 0, z ≈ 9.81

• Magnitude ≈ 9.81 m/s² (1g)

เมื่อเคลื่อนไหว:

• Magnitude > 9.81 หรือ < 9.81

• สามารถใช้ตรวจจับการเคลื่อนไหว!

2.2 เพิ่มโค้ดใน sensor_hub_daq_task.c

เพิ่มไว้หลังจาก lsb_to_rps():

/*******************************************************************************
 * Function Name: calculate_magnitude
 *******************************************************************************
 * Summary:
 *   คำนวณขนาดของ acceleration vector (magnitude)
 *   ใช้สำหรับตรวจจับการเคลื่อนไหว หรือการตกกระแทก
 *
 * Parameters:
 *   acc_x, acc_y, acc_z: ค่า acceleration ในหน่วย m/s²
 *
 * Return:
 *   float: ขนาดของ vector ในหน่วย m/s²
 *
 * Note:
 *   - วางราบ: magnitude ≈ 9.81 m/s² (1g)
 *   - เคลื่อนไหว: magnitude จะเบี่ยงเบนจาก 9.81
 ******************************************************************************/
static float calculate_magnitude(float acc_x, float acc_y, float acc_z)
{
    return sqrtf(acc_x * acc_x + acc_y * acc_y + acc_z * acc_z);
}

2.3 เพิ่มการเรียกใช้ใน Main Loop

แก้ไขใน sensor_hub_daq_task():

/* เพิ่มตัวแปร */
float magnitude = 0.0f;

/* ใน for(;;) loop หลังจากคำนวณ x, y, z ของ accelerometer */

/* เพิ่มหลังบรรทัด printf("Accelerometer:...") */
magnitude = calculate_magnitude(x, y, z);
printf("Magnitude: %9.6f m/s² (%.2f g)\n\n",
       (double)magnitude,
       (double)(magnitude / GRAVITY_EARTH));

2.4 Output ที่คาดหวัง

Accelerometer:
x: 0.012345, y: -0.023456, z: 9.806650
Magnitude: 9.806789 m/s² (1.00 g)

Gyroscope:
x: 0.001234, y: 0.002345, z: -0.003456

Orientation = ORIENTATION_UP

2.5 ทดลอง

• วางราบ: Magnitude ≈ 9.81 m/s² (1.00 g)

• เขย่าเบาๆ: Magnitude เปลี่ยนแปลง

• ตกกระแทก: Magnitude spike สูงขึ้นมาก

---

จบ Session 2 | ต่อไป: Session 3: LVGL Display