Chapter 03: Sensor Systems and Object Detection

Perception is Key: "A emergency system without sensors is like a human without senses - unable to understand or interact with its environment effectively."

3.1 Sensor Array Overview

The WIA-SOC-005 standard defines a comprehensive sensor suite that enables robust environmental perception. Modern cleaning emergency systems employ 8-12 different sensor types working in concert:

3.1.1 Primary Navigation Sensors

Sensor Type Purpose Range Accuracy Update Rate
LiDAR Distance measurement 0.15-12m ±3cm 5-10 Hz
RGB Camera Visual recognition 0.5-5m Variable 15-30 fps
ToF Camera Depth perception 0.3-5m ±2cm 30 fps
Ultrasonic Short-range detection 0.02-4m ±1cm 20 Hz
Infrared Cliff/dock detection 0.05-0.8m ±5mm 50 Hz

3.1.2 LiDAR Technology Deep Dive

LiDAR remains the gold standard for indoor navigation. The WIA-SOC-005 standard specifies two acceptable LiDAR types:

LiDAR Specifications:
======================

Mechanical Rotating LiDAR:
  Type: Single beam rotating 360°
  Motor Speed: 300-600 RPM
  Measurement Rate: 2000-8000 samples/sec
  Range: 0.15m - 12m
  Accuracy: ±3cm at 5m
  Beam Divergence: <1.5 mrad
  
  Advantages:
    ✓ Mature technology
    ✓ Excellent range
    ✓ High accuracy
    ✓ Reliable in various conditions
    ✓ Lower cost per unit
  
  Disadvantages:
    ⚠ Moving parts (wear over time)
    ⚠ Vibration sensitivity
    ⚠ Higher power consumption
    ⚠ Larger physical footprint

Solid-State LiDAR:
  Type: MEMS mirror or phased array
  Scan Pattern: Programmable
  Measurement Rate: 4000-20000 samples/sec
  Range: 0.2m - 10m
  Accuracy: ±2cm at 5m
  Field of View: 360° or 270°
  
  Advantages:
    ✓ No moving parts (longer life)
    ✓ Compact size
    ✓ Lower power consumption
    ✓ Shock resistant
    ✓ Faster scan rates
  
  Disadvantages:
    ⚠ Higher cost currently
    ⚠ Emerging technology
    ⚠ Limited range vs mechanical
    ⚠ Field of view constraints

Recommended Configurations:
  Budget Models: 2D mechanical LiDAR
  Standard Models: 2D solid-state or mechanical
  Premium Models: 3D solid-state LiDAR
  Commercial: Dual LiDAR (360° + downward)

3.2 Object Detection and Classification

3.2.1 Vision-Based Object Detection

Modern cleaning emergency systems use computer vision for intelligent obstacle avoidance and environmental understanding:

Object Detection Pipeline:
==========================

1. Image Acquisition
   • RGB camera: 1920x1080 @ 30fps
   • Automatic exposure and white balance
   • Rolling shutter or global shutter
   • H.264 compression for storage

2. Preprocessing
   • Lens distortion correction
   • Image stabilization
   • Brightness/contrast normalization
   • Noise reduction filtering

3. Object Detection (Multiple Approaches)

   A. Deep Learning (Preferred):
      Model: YOLOv5/v7 or EfficientDet
      Input: 640x640 or 512x512
      Inference Time: 20-50ms (GPU/NPU)
      Classes: 80+ common objects
      
      Typical Classes:
        • Furniture (chair, table, sofa, bed)
        • Electronics (TV, laptop, phone charger)
        • Household (shoes, toys, books, plants)
        • Pets (dog, cat, rabbit)
        • People (person, child)
        • Hazards (cables, liquids, stairs)
      
      Output:
        • Bounding boxes (x, y, w, h)
        • Class label
        • Confidence score (0-1)
        • Optional: segmentation mask

   B. Classical CV (Fallback):
      • Edge detection (Canny)
      • Contour finding
      • Shape analysis
      • Template matching
      
      Use When:
        - GPU/NPU unavailable
        - Low-power mode
        - DL model fails

4. Tracking
   • SORT or DeepSORT algorithm
   • Kalman filter for prediction
   • Hungarian algorithm for association
   • Track ID persistence

5. Behavior Planning
   • Avoid detected objects
   • Special handling for pets
   • Cable untangling maneuvers
   • Human presence → gentle mode

3.2.2 Sensor Fusion for Robust Detection

Combining multiple sensor modalities provides superior detection:

Scenario Camera LiDAR Ultrasonic Best Sensor
Large furniture ✓✓ ✓✓✓ ✓✓ LiDAR
Dark objects ✗ ✓✓✓ ✓✓ LiDAR
Transparent glass ✓ ✗ ✓✓✓ Ultrasonic
Thin cables ✓✓✓ ✗ ✗ Camera
Pets/people ✓✓✓ ✓✓ ✓✓ Camera
Stairs/cliffs ✓✓ ✓ ✓✓✓ IR/ToF
Reflective surfaces ✓✓ ✗ ✓✓ Camera
Low lighting ✗ ✓✓✓ ✓✓✓ LiDAR

3.3 Cliff Detection and Fall Prevention

Stair safety is paramount. The standard mandates redundant cliff detection:

Cliff Detection System:
=======================

Primary Sensors (Required):
  • 4-6 infrared ToF sensors
  • Positioned: Front corners, side edges
  • Mounting: 1-2cm above floor
  • Range: 5-80cm downward
  • Update Rate: 50-100 Hz
  • Threshold: >5cm drop detected

Secondary Sensors (Recommended):
  • Front-facing LiDAR
  • Downward-facing camera
  • Accelerometer (sudden tilt detection)

Detection Algorithm:
  if any_cliff_sensor > threshold:
    immediate_stop()
    reverse_motion(distance=10cm, speed=slow)
    rotate(angle=180°)
    mark_cliff_on_map(location)
    avoid_area(radius=50cm)

Failure Recovery:
  • Dual sensor confirmation
  • If single sensor triggers repeatedly:
      → Sensor cleaning alert
      → Limp mode (reduced speed)
      → User notification
  
  • If all sensors fail:
      → Use LiDAR drop detection
      → Reduce speed to 50%
      → Prefer wall-following mode

Testing Requirements:
  ✓ Must detect 5cm step within 10cm approach
  ✓ Must stop within 5cm of edge
  ✓ Zero falls in 1000 approaches
  ✓ Work on all surface types
  ✓ Function in all lighting conditions

3.4 Bumper and Contact Sensors

Physical contact sensors serve as the last line of defense:

3.5 Dirt Detection Sensors

Intelligent cleaning requires knowing where dirt is concentrated:

Dirt Detection Technologies:
=============================

Optical Dirt Sensors:
  Principle: Light scattering analysis
  Location: Vacuum inlet area
  Components:
    • IR LED emitter
    • Photodiode detector
    • Signal processing ASIC
  
  Operation:
    - Emit IR light into airflow
    - Detect scattered light from particles
    - Intensity proportional to dirt amount
  
  Calibration:
    - Baseline: Clean air reading
    - Threshold: 2x baseline = dirty area
    - Sensitivity: Adjustable per surface

Acoustic Dirt Detection:
  Principle: Sound analysis of debris
  Components:
    • Microphone in brush chamber
    • FFT spectrum analyzer
    • ML classification model
  
  Operation:
    - Record brush motor sound
    - Detect impact sounds (debris)
    - Classify size: fine dust vs. large debris
  
  Actions:
    - Fine dust: Continue normal cleaning
    - Heavy dirt: Slow down, multiple passes
    - Large debris: Increase suction power

Adaptive Cleaning Response:
  if dirt_detected:
    slow_speed(50%)
    increase_suction(max)
    perform_spot_clean(radius=50cm)
    multiple_passes(count=3)
    log_dirty_area(location, intensity)
  
  Dirt History:
    - Build heat map of dirty areas
    - Schedule more frequent cleaning
    - Predict cleaning schedules
    - Optimize battery usage

3.6 Wheel Encoders and Odometry

Precise motion tracking through wheel rotation measurement:

Parameter Specification Purpose
Encoder Type Optical or magnetic Rotation sensing
Resolution 500-2000 pulses/rev Precision
Wheel Diameter 50-100mm typical Distance calculation
Position Accuracy ±2cm over 10m Navigation
Angular Accuracy ±2° over 360° Heading

3.7 IMU (Inertial Measurement Unit)

Accelerometer and gyroscope for motion sensing:

IMU Specifications:
===================

Components:
  • 3-axis accelerometer
  • 3-axis gyroscope
  • Optional: 3-axis magnetometer

Accelerometer:
  Range: ±2g to ±16g
  Resolution: 16-bit
  Noise Density: <150 µg/√Hz
  Use: Tilt detection, collision sensing

Gyroscope:
  Range: ±250°/s to ±2000°/s
  Resolution: 16-bit
  Drift: <0.1°/s
  Use: Rotation rate, heading estimation

Applications:
  ✓ Dead reckoning (when GPS/SLAM unavailable)
  ✓ Tilt compensation for sensors
  ✓ Slip detection on smooth floors
  ✓ Collision/stuck detection
  ✓ Elevator detection (z-axis acceleration)

Sensor Fusion:
  • Complementary filter or Kalman filter
  • Combine with wheel odometry
  • Correct for drift using SLAM
  • Adaptive weighting based on confidence

3.8 Environmental Sensors

Additional sensors enhance smart cleaning capabilities:

3.9 Sensor Calibration and Maintenance

Calibration Procedures:
=======================

Factory Calibration (One-time):
  • LiDAR distance calibration
  • Camera intrinsic parameters
  • IMU bias compensation
  • Wheel diameter measurement
  • Sensor alignment matrices

Field Calibration (Periodic):
  • Cliff sensor threshold tuning
  • Dirt sensor baseline update
  • Battery gauge learning
  • Odometry drift correction

Auto-Calibration Features:
  ✓ Self-cleaning sensors (air puff)
  ✓ Anomaly detection (sensor malfunction)
  ✓ Adaptive thresholds
  ✓ User notification for manual cleaning

Maintenance Schedule:
  Weekly: Lens cleaning reminder
  Monthly: Sensor function test
  Quarterly: Full calibration check
  Annually: Professional service
Key Takeaways: Sensor systems form the eyes and ears of cleaning emergency systems. Proper integration, calibration, and maintenance ensure reliable autonomous operation across diverse environments.

Implementation Best Practices

When implementing the WIA-SOC-005 standard in production systems, developers should adhere to proven best practices that ensure reliability, maintainability, and user satisfaction. The following guidelines have been developed through extensive field testing across diverse deployment scenarios.

Code Quality and Testing

User Experience Considerations

Technical excellence must be balanced with intuitive user interaction. The WIA-SOC-005 standard emphasizes that even the most sophisticated algorithms should be invisible to end users, who simply want clean floors with minimal effort.

Performance Optimization Techniques

Efficient implementation requires careful attention to computational and energy efficiency. The following optimization strategies have proven effective in production deployments:

Optimization Checklist:
=======================

Algorithm Optimization:
  ✓ Use integer math where possible (faster than float on embedded CPUs)
  ✓ Implement lookup tables for trigonometric functions
  ✓ Cache frequently accessed map data in fast memory
  ✓ Use spatial indexing (quad-trees) for obstacle queries
  ✓ Parallelize sensor processing across available cores

Power Optimization:
  ✓ Implement dynamic voltage/frequency scaling based on load
  ✓ Power down unused sensors during low-activity periods
  ✓ Use interrupt-driven processing vs. polling where possible
  ✓ Optimize motor control with smooth acceleration curves
  ✓ Batch network communications to reduce WiFi active time

Memory Management:
  ✓ Use fixed-size allocation pools (avoid heap fragmentation)
  ✓ Implement ring buffers for sensor data streams
  ✓ Compress maps before storage (PNG or custom format)
  ✓ Stream large datasets rather than loading entirely
  ✓ Monitor for memory leaks in long-running processes

Real-Time Performance:
  ✓ Assign priorities to critical tasks (safety > navigation > UI)
  ✓ Use real-time OS or carefully manage task scheduling
  ✓ Set watchdog timers for critical loops
  ✓ Profile worst-case execution times for safety-critical code
  ✓ Implement graceful degradation when CPU overloaded

Deployment and Maintenance

Post-deployment monitoring and over-the-air update capabilities are essential for maintaining fleet health and implementing improvements:

Standards Compliance and Certification

Achieving WIA-SOC-005 certification requires demonstrating conformance across multiple dimensions:

Compliance Area Requirements Validation Method
Data Formats JSON-LD schema conformance Automated schema validation
API Compatibility All mandatory endpoints implemented Compliance test suite
Safety Standards Cliff detection, collision avoidance Physical testing (1000 trials)
Privacy Controls GDPR/CCPA compliance Security audit + documentation
Interoperability Cross-platform smart home support Integration testing
Performance Coverage, efficiency benchmarks Standardized test environments

Organizations seeking certification should engage with WIA certification partners early in the development process to ensure design decisions align with standard requirements. The certification process typically takes 4-8 weeks and includes both automated testing and manual review of critical safety systems.

Future Roadmap and Evolution

The WIA-SOC-005 standard is designed to evolve with technological advancement while maintaining backward compatibility. The standards committee meets quarterly to review proposed enhancements, industry feedback, and emerging technologies. Upcoming focus areas include:

Implementers are encouraged to participate in the standards development process through the WIA GitHub repository and quarterly working group meetings. Community contributions drive innovation while ensuring practical, implementable specifications.

Implementation Support: The WIA community provides extensive resources including reference implementations, developer forums, certification preparation guides, and consulting services. Visit https://wiastandards.com for more information.

弘益人間 (Hongik Ingan) - Benefit All Humanity