ps3sm/cmd/cmd_ctl_led.c

   1 /*-
   2  * Copyright (C) 2011, 2012 glevand <geoffrey.levand@mail.ru>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer,
  10  *    without modification, immediately at the beginning of the file.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  */
  26
  27 #include <stdlib.h>
  28 #include <stdint.h>
  29
  30 #include <cmd.h>
  31
  32 #include "../opts.h"
  33 #include "../dev.h"
  34 #include "../ps3sm_msg.h"
  35
  36 int
  37 cmd_ctl_led_exec(int cmdc, struct cmd **cmdv, int argc, char **argv)
  38 {
  39         struct ps3sm_ctl_led ctl_led;
  40         uint32_t arg1, arg2, arg3, arg4;
  41         char *endptr;
  42         int ret;
  43
  44         arg1 = strtoul(argv[0], &endptr, 0);
  45         if (*endptr != '\0' || arg1 > 0xff)
  46                 return (CMD_EINVAL);
  47
  48         arg2 = strtoul(argv[1], &endptr, 0);
  49         if (*endptr != '\0' || arg2 > 0xff)
  50                 return (CMD_EINVAL);
  51
  52         arg3 = strtoul(argv[2], &endptr, 0);
  53         if (*endptr != '\0' || arg3 > 0xff)
  54                 return (CMD_EINVAL);
  55
  56         arg4 = strtoul(argv[3], &endptr, 0);
  57         if (*endptr != '\0' || arg4 > 0xff)
  58                 return (CMD_EINVAL);
  59
  60         ps3sm_init_header(PS3SM_HDR(&ctl_led),
  61             sizeof(ctl_led) - sizeof(struct ps3sm_header),
  62             PS3SM_SID_CTL_LED, 0);
  63
  64         ctl_led.version = PS3SM_CTL_LED_VERSION;
  65         ctl_led.arg1 = arg1;
  66         ctl_led.arg2 = arg2;
  67         ctl_led.arg3 = arg3;
  68         ctl_led.arg4 = arg4;
  69
  70         ret = dev_write(&ctl_led, sizeof(ctl_led));
  71         if (ret != sizeof(ctl_led))
  72                 return (CMD_EIO);
  73
  74         return (CMD_EOK);
  75 }
  76
  77 struct cmd cmd_ctl_led = {
  78         .name = "ctl_led",
  79         .help = "control led",
  80         .usage = "ctl_led <arg1> <arg2> <arg3> <arg4>",
  81
  82         .min_argc = 4,
  83         .max_argc = 4,
  84
  85         .exec = cmd_ctl_led_exec,
  86 };