Metric SLAM in Home Environment with Visual Objects and Sonar Features