src/servo_motor.c

   1 /*
   2  * Copyright (c) 2017 Samsung Electronics Co., Ltd.
   3  *
   4  * Contact: Jeonghoon Park <jh1979.park@samsung.com>
   5  *
   6  * Licensed under the Flora License, Version 1.1 (the License);
   7  * you may not use this file except in compliance with the License.
   8  * You may obtain a copy of the License at
   9  *
  10  * http://floralicense.org/license/
  11  *
  12  * Unless required by applicable law or agreed to in writing, software
  13  * distributed under the License is distributed on an AS IS BASIS,
  14  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  15  * See the License for the specific language governing permissions and
  16  * limitations under the License.
  17  */
  18
  19 #include "log.h"
  20 #include "pca9685.h"
  21
  22 int servo_motor_init(void)
  23 {
  24         int ret = 0;
  25         ret = pca9685_init();
  26         if (ret) {
  27                 _E("failed to init PCA9685");
  28                 return -1;
  29         }
  30
  31         return 0;
  32 }
  33
  34 int servo_motor_fini(void)
  35 {
  36         pca9685_fini();
  37         return 0;
  38 }
  39
  40 int servo_motor_value_set(int motor_id, int value)
  41 {
  42         int ret = 0;
  43         ret = pca9685_set_value_to_channel(motor_id, 0, value);
  44         return ret;
  45 }