xref: /aosp_15_r20/external/sg3_utils/src/sg_timestamp.c (revision 44704f698541f6367e81f991ef8bb54ccbf3fc18)
1*44704f69SBart Van Assche /*
2*44704f69SBart Van Assche  * Copyright (c) 2015-2021 Douglas Gilbert.
3*44704f69SBart Van Assche  * All rights reserved.
4*44704f69SBart Van Assche  * Use of this source code is governed by a BSD-style
5*44704f69SBart Van Assche  * license that can be found in the BSD_LICENSE file.
6*44704f69SBart Van Assche  *
7*44704f69SBart Van Assche  * SPDX-License-Identifier: BSD-2-Clause
8*44704f69SBart Van Assche  */
9*44704f69SBart Van Assche 
10*44704f69SBart Van Assche #include <unistd.h>
11*44704f69SBart Van Assche #include <fcntl.h>
12*44704f69SBart Van Assche #include <stdio.h>
13*44704f69SBart Van Assche #include <stdlib.h>
14*44704f69SBart Van Assche #include <stdarg.h>
15*44704f69SBart Van Assche #include <stdbool.h>
16*44704f69SBart Van Assche #include <string.h>
17*44704f69SBart Van Assche #include <ctype.h>
18*44704f69SBart Van Assche #include <getopt.h>
19*44704f69SBart Van Assche #define __STDC_FORMAT_MACROS 1
20*44704f69SBart Van Assche #include <inttypes.h>
21*44704f69SBart Van Assche 
22*44704f69SBart Van Assche #ifdef HAVE_CONFIG_H
23*44704f69SBart Van Assche #include "config.h"
24*44704f69SBart Van Assche #endif
25*44704f69SBart Van Assche 
26*44704f69SBart Van Assche #include "sg_lib.h"
27*44704f69SBart Van Assche #include "sg_lib_data.h"
28*44704f69SBart Van Assche #include "sg_pt.h"
29*44704f69SBart Van Assche #include "sg_cmds_basic.h"
30*44704f69SBart Van Assche #include "sg_unaligned.h"
31*44704f69SBart Van Assche #include "sg_pr2serr.h"
32*44704f69SBart Van Assche 
33*44704f69SBart Van Assche /* A utility program originally written for the Linux OS SCSI subsystem.
34*44704f69SBart Van Assche  *
35*44704f69SBart Van Assche  *
36*44704f69SBart Van Assche  * This program issues a SCSI REPORT TIMESTAMP and SET TIMESTAMP commands
37*44704f69SBart Van Assche  * to the given SCSI device. Based on spc5r07.pdf .
38*44704f69SBart Van Assche  */
39*44704f69SBart Van Assche 
40*44704f69SBart Van Assche static const char * version_str = "1.14 20210830";
41*44704f69SBart Van Assche 
42*44704f69SBart Van Assche #define REP_TIMESTAMP_CMDLEN 12
43*44704f69SBart Van Assche #define SET_TIMESTAMP_CMDLEN 12
44*44704f69SBart Van Assche #define REP_TIMESTAMP_SA 0xf
45*44704f69SBart Van Assche #define SET_TIMESTAMP_SA 0xf
46*44704f69SBart Van Assche 
47*44704f69SBart Van Assche #define SENSE_BUFF_LEN 64       /* Arbitrary, could be larger */
48*44704f69SBart Van Assche #define DEF_PT_TIMEOUT  60      /* 60 seconds */
49*44704f69SBart Van Assche 
50*44704f69SBart Van Assche uint8_t d_buff[256];
51*44704f69SBart Van Assche 
52*44704f69SBart Van Assche /* example Report timestamp parameter data */
53*44704f69SBart Van Assche /* uint8_t test[12] = {0, 0xa, 2, 0, 0x1, 0x51, 0x5b, 0xe2, 0xc1, 0x30,
54*44704f69SBart Van Assche  *                     0, 0}; */
55*44704f69SBart Van Assche 
56*44704f69SBart Van Assche 
57*44704f69SBart Van Assche static struct option long_options[] = {
58*44704f69SBart Van Assche         {"elapsed", no_argument, 0, 'e'},
59*44704f69SBart Van Assche         {"help", no_argument, 0, 'h'},
60*44704f69SBart Van Assche         {"hex", no_argument, 0, 'H'},
61*44704f69SBart Van Assche         {"milliseconds", required_argument, 0, 'm'},
62*44704f69SBart Van Assche         {"no_timestamp", no_argument, 0, 'N'},
63*44704f69SBart Van Assche         {"no-timestamp", no_argument, 0, 'N'},
64*44704f69SBart Van Assche         {"origin", no_argument, 0, 'o'},
65*44704f69SBart Van Assche         {"raw", no_argument, 0, 'r'},
66*44704f69SBart Van Assche         {"readonly", no_argument, 0, 'R'},
67*44704f69SBart Van Assche         {"seconds", required_argument, 0, 's'},
68*44704f69SBart Van Assche         {"srep", no_argument, 0, 'S'},
69*44704f69SBart Van Assche         {"verbose", no_argument, 0, 'v'},
70*44704f69SBart Van Assche         {"version", no_argument, 0, 'V'},
71*44704f69SBart Van Assche         {0, 0, 0, 0},
72*44704f69SBart Van Assche };
73*44704f69SBart Van Assche 
74*44704f69SBart Van Assche /* Indexed by 'timestamp origin' field value */
75*44704f69SBart Van Assche static const char * ts_origin_arr[] = {
76*44704f69SBart Van Assche     "initialized to zero at power on or by hard reset",
77*44704f69SBart Van Assche     "reserved [0x1]",
78*44704f69SBart Van Assche     "initialized by SET TIMESTAMP command",
79*44704f69SBart Van Assche     "initialized by other method",
80*44704f69SBart Van Assche     "reserved [0x4]",
81*44704f69SBart Van Assche     "reserved [0x5]",
82*44704f69SBart Van Assche     "reserved [0x6]",
83*44704f69SBart Van Assche     "reserved [0x7]",
84*44704f69SBart Van Assche };
85*44704f69SBart Van Assche 
86*44704f69SBart Van Assche 
87*44704f69SBart Van Assche static void
usage(int num)88*44704f69SBart Van Assche usage(int num)
89*44704f69SBart Van Assche {
90*44704f69SBart Van Assche     if (num > 1)
91*44704f69SBart Van Assche         goto page2;
92*44704f69SBart Van Assche 
93*44704f69SBart Van Assche     pr2serr("Usage: "
94*44704f69SBart Van Assche             "sg_timestamp  [--elapsed] [--help] [--hex] [--milliseconds=MS]\n"
95*44704f69SBart Van Assche             "                     [--no-timestamp] [--origin] [--raw] "
96*44704f69SBart Van Assche             "[--readonly]\n"
97*44704f69SBart Van Assche             "                     [--seconds=SECS] [--srep] [--verbose] "
98*44704f69SBart Van Assche             "[--version]\n"
99*44704f69SBart Van Assche             "                     DEVICE\n"
100*44704f69SBart Van Assche            );
101*44704f69SBart Van Assche     pr2serr("  where:\n"
102*44704f69SBart Van Assche             "    --elapsed|-e       show time as '<n> days hh:mm:ss.xxx' "
103*44704f69SBart Van Assche             "where\n"
104*44704f69SBart Van Assche             "                       '.xxx' is the remainder milliseconds. "
105*44704f69SBart Van Assche             "Don't show\n"
106*44704f69SBart Van Assche             "                       '<n> days' if <n> is 0 (unless '-e' "
107*44704f69SBart Van Assche             "given twice)\n"
108*44704f69SBart Van Assche             "    --help|-h          print out usage message, use twice for "
109*44704f69SBart Van Assche             "examples\n"
110*44704f69SBart Van Assche             "    --hex|-H           output response in ASCII hexadecimal\n"
111*44704f69SBart Van Assche             "    --milliseconds=MS|-m MS    set timestamp to MS "
112*44704f69SBart Van Assche             "milliseconds since\n"
113*44704f69SBart Van Assche             "                               1970-01-01 00:00:00 UTC\n"
114*44704f69SBart Van Assche             "    --no-timestamp|-N    suppress output of timestamp\n"
115*44704f69SBart Van Assche             "    --origin|-o        show Report timestamp origin "
116*44704f69SBart Van Assche             "(def: don't)\n"
117*44704f69SBart Van Assche             "                       used twice outputs value of field\n"
118*44704f69SBart Van Assche             "                       0: power up or hard reset; 2: SET "
119*44704f69SBart Van Assche             "TIMESTAMP\n"
120*44704f69SBart Van Assche             "    --raw|-r           output Report timestamp response to "
121*44704f69SBart Van Assche             "stdout in\n"
122*44704f69SBart Van Assche             "                       binary\n"
123*44704f69SBart Van Assche             "    --readonly|-R      open DEVICE read only (def: "
124*44704f69SBart Van Assche             "read/write)\n"
125*44704f69SBart Van Assche             "    --seconds=SECS|-s SECS    set timestamp to SECS "
126*44704f69SBart Van Assche             "seconds since\n"
127*44704f69SBart Van Assche             "                            1970-01-01 00:00:00 UTC\n"
128*44704f69SBart Van Assche             "    --srep|-S          output Report timestamp in seconds "
129*44704f69SBart Van Assche             "(def:\n"
130*44704f69SBart Van Assche             "                       milliseconds)\n"
131*44704f69SBart Van Assche             "    --verbose|-v       increase verbosity\n"
132*44704f69SBart Van Assche             "    --version|-V       print version string and exit\n\n"
133*44704f69SBart Van Assche           );
134*44704f69SBart Van Assche     pr2serr("Performs a SCSI REPORT TIMESTAMP or SET TIMESTAMP command. "
135*44704f69SBart Van Assche             "The timestamp\nis SET if either the --milliseconds=MS or "
136*44704f69SBart Van Assche             "--seconds=SECS option is given,\notherwise the existing "
137*44704f69SBart Van Assche             "timestamp is reported in milliseconds. The\nDEVICE stores "
138*44704f69SBart Van Assche             "the timestamp as the number of milliseconds since power up\n"
139*44704f69SBart Van Assche             "(or reset) or since 1970-01-01 00:00:00 UTC which also "
140*44704f69SBart Van Assche             "happens to\nbe the time 'epoch'of Unix machines.\n\n"
141*44704f69SBart Van Assche             "Use '-hh' (the '-h' option twice) for examples.\n"
142*44704f69SBart Van Assche #if 0
143*44704f69SBart Van Assche  "The 'date +%%s' command in "
144*44704f69SBart Van Assche             "Unix returns the number of\nseconds since the epoch. To "
145*44704f69SBart Van Assche             "convert a reported timestamp (in seconds since\nthe epoch) "
146*44704f69SBart Van Assche             "to a more readable form use "
147*44704f69SBart Van Assche             "'date --date=@<secs_since_epoch>' .\n"
148*44704f69SBart Van Assche #endif
149*44704f69SBart Van Assche            );
150*44704f69SBart Van Assche     return;
151*44704f69SBart Van Assche page2:
152*44704f69SBart Van Assche     pr2serr("sg_timestamp examples:\n"
153*44704f69SBart Van Assche             "It is possible that the target device containing a SCSI "
154*44704f69SBart Van Assche             "Logical Unit (LU)\nhas a battery (or supercapacitor) to "
155*44704f69SBart Van Assche             "keep its RTC (real time clock)\nticking during a power "
156*44704f69SBart Van Assche             "outage. More likely it doesn't and its RTC is\ncleared to "
157*44704f69SBart Van Assche             "zero after a power cycle or hard reset.\n\n"
158*44704f69SBart Van Assche             "Either way REPORT TIMESTAMP returns a 48 bit counter value "
159*44704f69SBart Van Assche             "whose unit is\na millisecond. A heuristic to determine if a "
160*44704f69SBart Van Assche             "date or elapsed time is\nbeing returned is to choose a date "
161*44704f69SBart Van Assche             "like 1 January 2000 which is 30 years\nafter the Unix epoch "
162*44704f69SBart Van Assche             "(946,684,800,000 milliseconds) and values less than\nthat are "
163*44704f69SBart Van Assche             "elapsed times and greater are timestamps. Observing the "
164*44704f69SBart Van Assche             "TIMESTAMP\nORIGIN field of REPORT TIMESTAMP is a better "
165*44704f69SBart Van Assche             "method:\n\n"
166*44704f69SBart Van Assche            );
167*44704f69SBart Van Assche     pr2serr(" $ sg_timestamp -o -N /dev/sg1\n"
168*44704f69SBart Van Assche             "Device clock initialized to zero at power on or by hard "
169*44704f69SBart Van Assche             "reset\n"
170*44704f69SBart Van Assche             " $ sg_timestamp -oo -N /dev/sg1\n"
171*44704f69SBart Van Assche             "0\n\n"
172*44704f69SBart Van Assche             " $ sg_timestamp /dev/sg1\n"
173*44704f69SBart Van Assche             "3984499\n"
174*44704f69SBart Van Assche             " $ sg_timestamp --elapsed /dev/sg1\n"
175*44704f69SBart Van Assche             "01:06:28.802\n\n"
176*44704f69SBart Van Assche             "The last output indicates an elapsed time of 1 hour, 6 minutes "
177*44704f69SBart Van Assche             "and 28.802\nseconds. Next set the clock to the current time:\n\n"
178*44704f69SBart Van Assche             " $ sg_timestamp --seconds=`date +%%s` /dev/sg1\n\n"
179*44704f69SBart Van Assche             " $ sg_timestamp -o -N /dev/sg1\n"
180*44704f69SBart Van Assche             "Device clock initialized by SET TIMESTAMP command\n\n"
181*44704f69SBart Van Assche             "Now show that as an elapsed time:\n\n"
182*44704f69SBart Van Assche             " $ sg_timestamp -e /dev/sg1\n"
183*44704f69SBart Van Assche             "17652 days 20:53:22.545\n\n"
184*44704f69SBart Van Assche             "That is over 48 years worth of days. Lets try again as a "
185*44704f69SBart Van Assche             "data-time\nstamp in UTC:\n\n"
186*44704f69SBart Van Assche             " $ date -u -R --date=@`sg_timestamp -S /dev/sg1`\n"
187*44704f69SBart Van Assche             "Tue, 01 May 2018 20:56:38 +0000\n"
188*44704f69SBart Van Assche            );
189*44704f69SBart Van Assche }
190*44704f69SBart Van Assche 
191*44704f69SBart Van Assche /* Invokes a SCSI REPORT TIMESTAMP command.  Return of 0 -> success,
192*44704f69SBart Van Assche  * various SG_LIB_CAT_* positive values or -1 -> other errors */
193*44704f69SBart Van Assche static int
sg_ll_rep_timestamp(int sg_fd,void * resp,int mx_resp_len,int * residp,bool noisy,int verbose)194*44704f69SBart Van Assche sg_ll_rep_timestamp(int sg_fd, void * resp, int mx_resp_len, int * residp,
195*44704f69SBart Van Assche                     bool noisy, int verbose)
196*44704f69SBart Van Assche {
197*44704f69SBart Van Assche     int k, ret, res, sense_cat;
198*44704f69SBart Van Assche     uint8_t rt_cdb[REP_TIMESTAMP_CMDLEN] =
199*44704f69SBart Van Assche           {SG_MAINTENANCE_IN, REP_TIMESTAMP_SA, 0, 0,  0, 0, 0, 0, 0, 0, 0, 0};
200*44704f69SBart Van Assche     uint8_t sense_b[SENSE_BUFF_LEN] SG_C_CPP_ZERO_INIT;
201*44704f69SBart Van Assche     struct sg_pt_base * ptvp;
202*44704f69SBart Van Assche 
203*44704f69SBart Van Assche     sg_put_unaligned_be32((uint32_t)mx_resp_len, rt_cdb + 6);
204*44704f69SBart Van Assche     if (verbose) {
205*44704f69SBart Van Assche         char b[128];
206*44704f69SBart Van Assche 
207*44704f69SBart Van Assche         pr2serr("    Report timestamp cdb: %s\n",
208*44704f69SBart Van Assche                 sg_get_command_str(rt_cdb, REP_TIMESTAMP_CMDLEN, false,
209*44704f69SBart Van Assche                                    sizeof(b), b));
210*44704f69SBart Van Assche     }
211*44704f69SBart Van Assche 
212*44704f69SBart Van Assche     ptvp = construct_scsi_pt_obj();
213*44704f69SBart Van Assche     if (NULL == ptvp) {
214*44704f69SBart Van Assche         pr2serr("%s: out of memory\n", __func__);
215*44704f69SBart Van Assche         return -1;
216*44704f69SBart Van Assche     }
217*44704f69SBart Van Assche     set_scsi_pt_cdb(ptvp, rt_cdb, sizeof(rt_cdb));
218*44704f69SBart Van Assche     set_scsi_pt_sense(ptvp, sense_b, sizeof(sense_b));
219*44704f69SBart Van Assche     set_scsi_pt_data_in(ptvp, (uint8_t *)resp, mx_resp_len);
220*44704f69SBart Van Assche     res = do_scsi_pt(ptvp, sg_fd, DEF_PT_TIMEOUT, verbose);
221*44704f69SBart Van Assche     ret = sg_cmds_process_resp(ptvp, "report timestamp", res, noisy, verbose,
222*44704f69SBart Van Assche                                &sense_cat);
223*44704f69SBart Van Assche     if (-1 == ret) {
224*44704f69SBart Van Assche         if (get_scsi_pt_transport_err(ptvp))
225*44704f69SBart Van Assche             ret = SG_LIB_TRANSPORT_ERROR;
226*44704f69SBart Van Assche         else
227*44704f69SBart Van Assche             ret = sg_convert_errno(get_scsi_pt_os_err(ptvp));
228*44704f69SBart Van Assche     } else if (-2 == ret) {
229*44704f69SBart Van Assche         switch (sense_cat) {
230*44704f69SBart Van Assche         case SG_LIB_CAT_RECOVERED:
231*44704f69SBart Van Assche         case SG_LIB_CAT_NO_SENSE:
232*44704f69SBart Van Assche             ret = 0;
233*44704f69SBart Van Assche             break;
234*44704f69SBart Van Assche         default:
235*44704f69SBart Van Assche             ret = sense_cat;
236*44704f69SBart Van Assche             break;
237*44704f69SBart Van Assche         }
238*44704f69SBart Van Assche     } else
239*44704f69SBart Van Assche         ret = 0;
240*44704f69SBart Van Assche     k = get_scsi_pt_resid(ptvp);
241*44704f69SBart Van Assche     if (residp)
242*44704f69SBart Van Assche         *residp = k;
243*44704f69SBart Van Assche     if ((verbose > 2) && ((mx_resp_len - k) > 0)) {
244*44704f69SBart Van Assche         pr2serr("Parameter data returned:\n");
245*44704f69SBart Van Assche         hex2stderr((const uint8_t *)resp, mx_resp_len - k,
246*44704f69SBart Van Assche                    ((verbose > 3) ? -1 : 1));
247*44704f69SBart Van Assche     }
248*44704f69SBart Van Assche     destruct_scsi_pt_obj(ptvp);
249*44704f69SBart Van Assche     return ret;
250*44704f69SBart Van Assche }
251*44704f69SBart Van Assche 
252*44704f69SBart Van Assche 
253*44704f69SBart Van Assche /* Invokes the SET TIMESTAMP command.  Return of 0 -> success, various
254*44704f69SBart Van Assche  * SG_LIB_CAT_* positive values or -1 -> other errors */
255*44704f69SBart Van Assche static int
sg_ll_set_timestamp(int sg_fd,void * paramp,int param_len,bool noisy,int verbose)256*44704f69SBart Van Assche sg_ll_set_timestamp(int sg_fd, void * paramp, int param_len, bool noisy,
257*44704f69SBart Van Assche                     int verbose)
258*44704f69SBart Van Assche {
259*44704f69SBart Van Assche     int ret, res, sense_cat;
260*44704f69SBart Van Assche     uint8_t st_cdb[SET_TIMESTAMP_CMDLEN] =
261*44704f69SBart Van Assche           {SG_MAINTENANCE_OUT, SET_TIMESTAMP_SA, 0, 0,  0, 0, 0, 0,
262*44704f69SBart Van Assche            0, 0, 0, 0};
263*44704f69SBart Van Assche     uint8_t sense_b[SENSE_BUFF_LEN] SG_C_CPP_ZERO_INIT;
264*44704f69SBart Van Assche     struct sg_pt_base * ptvp;
265*44704f69SBart Van Assche 
266*44704f69SBart Van Assche     sg_put_unaligned_be32(param_len, st_cdb + 6);
267*44704f69SBart Van Assche     if (verbose) {
268*44704f69SBart Van Assche         char b[128];
269*44704f69SBart Van Assche 
270*44704f69SBart Van Assche         pr2serr("    Set timestamp cdb: %s\n",
271*44704f69SBart Van Assche                 sg_get_command_str(st_cdb, SET_TIMESTAMP_CMDLEN, false,
272*44704f69SBart Van Assche                                    sizeof(b), b));
273*44704f69SBart Van Assche         if ((verbose > 1) && paramp && param_len) {
274*44704f69SBart Van Assche             pr2serr("    set timestamp parameter list:\n");
275*44704f69SBart Van Assche             hex2stderr((const uint8_t *)paramp, param_len, -1);
276*44704f69SBart Van Assche         }
277*44704f69SBart Van Assche     }
278*44704f69SBart Van Assche 
279*44704f69SBart Van Assche     ptvp = construct_scsi_pt_obj();
280*44704f69SBart Van Assche     if (NULL == ptvp) {
281*44704f69SBart Van Assche         pr2serr("%s: out of memory\n", __func__);
282*44704f69SBart Van Assche         return -1;
283*44704f69SBart Van Assche     }
284*44704f69SBart Van Assche     set_scsi_pt_cdb(ptvp, st_cdb, sizeof(st_cdb));
285*44704f69SBart Van Assche     set_scsi_pt_sense(ptvp, sense_b, sizeof(sense_b));
286*44704f69SBart Van Assche     set_scsi_pt_data_out(ptvp, (uint8_t *)paramp, param_len);
287*44704f69SBart Van Assche     res = do_scsi_pt(ptvp, sg_fd, DEF_PT_TIMEOUT, verbose);
288*44704f69SBart Van Assche     ret = sg_cmds_process_resp(ptvp, "set timestamp", res, noisy, verbose,
289*44704f69SBart Van Assche                                &sense_cat);
290*44704f69SBart Van Assche     if (-1 == ret) {
291*44704f69SBart Van Assche         if (get_scsi_pt_transport_err(ptvp))
292*44704f69SBart Van Assche             ret = SG_LIB_TRANSPORT_ERROR;
293*44704f69SBart Van Assche         else
294*44704f69SBart Van Assche             ret = sg_convert_errno(get_scsi_pt_os_err(ptvp));
295*44704f69SBart Van Assche     } else if (-2 == ret) {
296*44704f69SBart Van Assche         switch (sense_cat) {
297*44704f69SBart Van Assche         case SG_LIB_CAT_RECOVERED:
298*44704f69SBart Van Assche         case SG_LIB_CAT_NO_SENSE:
299*44704f69SBart Van Assche             ret = 0;
300*44704f69SBart Van Assche             break;
301*44704f69SBart Van Assche         default:
302*44704f69SBart Van Assche             ret = sense_cat;
303*44704f69SBart Van Assche             break;
304*44704f69SBart Van Assche         }
305*44704f69SBart Van Assche     } else
306*44704f69SBart Van Assche         ret = 0;
307*44704f69SBart Van Assche     destruct_scsi_pt_obj(ptvp);
308*44704f69SBart Van Assche     return ret;
309*44704f69SBart Van Assche }
310*44704f69SBart Van Assche 
311*44704f69SBart Van Assche static void
dStrRaw(const uint8_t * str,int len)312*44704f69SBart Van Assche dStrRaw(const uint8_t * str, int len)
313*44704f69SBart Van Assche {
314*44704f69SBart Van Assche     int k;
315*44704f69SBart Van Assche 
316*44704f69SBart Van Assche     for (k = 0; k < len; ++k)
317*44704f69SBart Van Assche         printf("%c", str[k]);
318*44704f69SBart Van Assche }
319*44704f69SBart Van Assche 
320*44704f69SBart Van Assche 
321*44704f69SBart Van Assche int
main(int argc,char * argv[])322*44704f69SBart Van Assche main(int argc, char * argv[])
323*44704f69SBart Van Assche {
324*44704f69SBart Van Assche     bool do_srep = false;
325*44704f69SBart Van Assche     bool do_raw = false;
326*44704f69SBart Van Assche     bool no_timestamp = false;
327*44704f69SBart Van Assche     bool readonly = false;
328*44704f69SBart Van Assche     bool secs_given = false;
329*44704f69SBart Van Assche     bool verbose_given = false;
330*44704f69SBart Van Assche     bool version_given = false;
331*44704f69SBart Van Assche     int res, c;
332*44704f69SBart Van Assche     int sg_fd = 1;
333*44704f69SBart Van Assche     int elapsed = 0;
334*44704f69SBart Van Assche     int do_origin = 0;
335*44704f69SBart Van Assche     int do_help = 0;
336*44704f69SBart Van Assche     int do_hex = 0;
337*44704f69SBart Van Assche     int do_set = 0;
338*44704f69SBart Van Assche     int ret = 0;
339*44704f69SBart Van Assche     int verbose = 0;
340*44704f69SBart Van Assche     uint64_t secs = 0;
341*44704f69SBart Van Assche     uint64_t msecs = 0;
342*44704f69SBart Van Assche     int64_t ll;
343*44704f69SBart Van Assche     const char * device_name = NULL;
344*44704f69SBart Van Assche     const char * cmd_name;
345*44704f69SBart Van Assche 
346*44704f69SBart Van Assche     while (1) {
347*44704f69SBart Van Assche         int option_index = 0;
348*44704f69SBart Van Assche 
349*44704f69SBart Van Assche         c = getopt_long(argc, argv, "ehHm:NorRs:SvV", long_options,
350*44704f69SBart Van Assche                         &option_index);
351*44704f69SBart Van Assche         if (c == -1)
352*44704f69SBart Van Assche             break;
353*44704f69SBart Van Assche 
354*44704f69SBart Van Assche         switch (c) {
355*44704f69SBart Van Assche         case 'e':
356*44704f69SBart Van Assche             ++elapsed;
357*44704f69SBart Van Assche             break;
358*44704f69SBart Van Assche         case 'h':
359*44704f69SBart Van Assche         case '?':
360*44704f69SBart Van Assche             ++do_help;
361*44704f69SBart Van Assche             break;
362*44704f69SBart Van Assche         case 'H':
363*44704f69SBart Van Assche             ++do_hex;
364*44704f69SBart Van Assche             break;
365*44704f69SBart Van Assche         case 'm':
366*44704f69SBart Van Assche             ll = sg_get_llnum(optarg);
367*44704f69SBart Van Assche             if (-1 == ll) {
368*44704f69SBart Van Assche                 pr2serr("bad argument to '--milliseconds=MS'\n");
369*44704f69SBart Van Assche                 return SG_LIB_SYNTAX_ERROR;
370*44704f69SBart Van Assche             }
371*44704f69SBart Van Assche             msecs = (uint64_t)ll;
372*44704f69SBart Van Assche             ++do_set;
373*44704f69SBart Van Assche             break;
374*44704f69SBart Van Assche         case 'N':
375*44704f69SBart Van Assche             no_timestamp = true;
376*44704f69SBart Van Assche             break;
377*44704f69SBart Van Assche         case 'o':
378*44704f69SBart Van Assche             ++do_origin;
379*44704f69SBart Van Assche             break;
380*44704f69SBart Van Assche         case 'r':
381*44704f69SBart Van Assche             do_raw = true;
382*44704f69SBart Van Assche             break;
383*44704f69SBart Van Assche         case 'R':
384*44704f69SBart Van Assche             readonly = true;
385*44704f69SBart Van Assche             break;
386*44704f69SBart Van Assche         case 's':
387*44704f69SBart Van Assche             ll = sg_get_llnum(optarg);
388*44704f69SBart Van Assche             if (-1 == ll) {
389*44704f69SBart Van Assche                 pr2serr("bad argument to '--seconds=SECS'\n");
390*44704f69SBart Van Assche                 return SG_LIB_SYNTAX_ERROR;
391*44704f69SBart Van Assche             }
392*44704f69SBart Van Assche             secs = (uint64_t)ll;
393*44704f69SBart Van Assche             ++do_set;
394*44704f69SBart Van Assche             secs_given = true;
395*44704f69SBart Van Assche             break;
396*44704f69SBart Van Assche         case 'S':
397*44704f69SBart Van Assche             do_srep = true;
398*44704f69SBart Van Assche             break;
399*44704f69SBart Van Assche         case 'v':
400*44704f69SBart Van Assche             verbose_given = true;
401*44704f69SBart Van Assche             ++verbose;
402*44704f69SBart Van Assche             break;
403*44704f69SBart Van Assche         case 'V':
404*44704f69SBart Van Assche             version_given = true;
405*44704f69SBart Van Assche             break;
406*44704f69SBart Van Assche         default:
407*44704f69SBart Van Assche             pr2serr("unrecognised option code 0x%x ??\n", c);
408*44704f69SBart Van Assche             usage(1);
409*44704f69SBart Van Assche             return SG_LIB_SYNTAX_ERROR;
410*44704f69SBart Van Assche         }
411*44704f69SBart Van Assche     }
412*44704f69SBart Van Assche     if (optind < argc) {
413*44704f69SBart Van Assche         if (NULL == device_name) {
414*44704f69SBart Van Assche             device_name = argv[optind];
415*44704f69SBart Van Assche             ++optind;
416*44704f69SBart Van Assche         }
417*44704f69SBart Van Assche         if (optind < argc) {
418*44704f69SBart Van Assche             for (; optind < argc; ++optind)
419*44704f69SBart Van Assche                 pr2serr("Unexpected extra argument: %s\n", argv[optind]);
420*44704f69SBart Van Assche             usage(1);
421*44704f69SBart Van Assche             return SG_LIB_SYNTAX_ERROR;
422*44704f69SBart Van Assche         }
423*44704f69SBart Van Assche     }
424*44704f69SBart Van Assche     if (do_help) {
425*44704f69SBart Van Assche         usage(do_help);
426*44704f69SBart Van Assche         return 0;
427*44704f69SBart Van Assche     }
428*44704f69SBart Van Assche 
429*44704f69SBart Van Assche #ifdef DEBUG
430*44704f69SBart Van Assche     pr2serr("In DEBUG mode, ");
431*44704f69SBart Van Assche     if (verbose_given && version_given) {
432*44704f69SBart Van Assche         pr2serr("but override: '-vV' given, zero verbose and continue\n");
433*44704f69SBart Van Assche         verbose_given = false;
434*44704f69SBart Van Assche         version_given = false;
435*44704f69SBart Van Assche         verbose = 0;
436*44704f69SBart Van Assche     } else if (! verbose_given) {
437*44704f69SBart Van Assche         pr2serr("set '-vv'\n");
438*44704f69SBart Van Assche         verbose = 2;
439*44704f69SBart Van Assche     } else
440*44704f69SBart Van Assche         pr2serr("keep verbose=%d\n", verbose);
441*44704f69SBart Van Assche #else
442*44704f69SBart Van Assche     if (verbose_given && version_given)
443*44704f69SBart Van Assche         pr2serr("Not in DEBUG mode, so '-vV' has no special action\n");
444*44704f69SBart Van Assche #endif
445*44704f69SBart Van Assche     if (version_given) {
446*44704f69SBart Van Assche         pr2serr("version: %s\n", version_str);
447*44704f69SBart Van Assche         return 0;
448*44704f69SBart Van Assche     }
449*44704f69SBart Van Assche 
450*44704f69SBart Van Assche     if (do_set > 1) {
451*44704f69SBart Van Assche         pr2serr("either --milliseconds=MS or --seconds=SECS may be given, "
452*44704f69SBart Van Assche                 "not both\n");
453*44704f69SBart Van Assche         usage(1);
454*44704f69SBart Van Assche         return SG_LIB_CONTRADICT;
455*44704f69SBart Van Assche     }
456*44704f69SBart Van Assche 
457*44704f69SBart Van Assche     if (NULL == device_name) {
458*44704f69SBart Van Assche         pr2serr("missing device name!\n\n");
459*44704f69SBart Van Assche         usage(1);
460*44704f69SBart Van Assche         return SG_LIB_SYNTAX_ERROR;
461*44704f69SBart Van Assche     }
462*44704f69SBart Van Assche 
463*44704f69SBart Van Assche     sg_fd = sg_cmds_open_device(device_name, readonly, verbose);
464*44704f69SBart Van Assche     if (sg_fd < 0) {
465*44704f69SBart Van Assche         if (verbose)
466*44704f69SBart Van Assche             pr2serr("open error: %s: %s\n", device_name,
467*44704f69SBart Van Assche                     safe_strerror(-sg_fd));
468*44704f69SBart Van Assche         ret = sg_convert_errno(-sg_fd);
469*44704f69SBart Van Assche         goto fini;
470*44704f69SBart Van Assche     }
471*44704f69SBart Van Assche 
472*44704f69SBart Van Assche     memset(d_buff, 0, 12);
473*44704f69SBart Van Assche     if (do_set) {
474*44704f69SBart Van Assche         cmd_name = "Set timestamp";
475*44704f69SBart Van Assche         sg_put_unaligned_be48(secs_given ? (secs * 1000) : msecs, d_buff + 4);
476*44704f69SBart Van Assche         res = sg_ll_set_timestamp(sg_fd, d_buff, 12, true, verbose);
477*44704f69SBart Van Assche     } else {
478*44704f69SBart Van Assche         cmd_name = "Report timestamp";
479*44704f69SBart Van Assche         res = sg_ll_rep_timestamp(sg_fd, d_buff, 12, NULL, true, verbose);
480*44704f69SBart Van Assche         if (0 == res) {
481*44704f69SBart Van Assche             if (do_raw)
482*44704f69SBart Van Assche                 dStrRaw(d_buff, 12);
483*44704f69SBart Van Assche             else if (do_hex)
484*44704f69SBart Van Assche                 hex2stderr(d_buff, 12, 1);
485*44704f69SBart Van Assche             else {
486*44704f69SBart Van Assche                 int len = sg_get_unaligned_be16(d_buff + 0);
487*44704f69SBart Van Assche 
488*44704f69SBart Van Assche                 if (len < 8)
489*44704f69SBart Van Assche                     pr2serr("timestamp parameter data length too short, "
490*44704f69SBart Van Assche                             "expect >= 10, got %d\n", len + 2);
491*44704f69SBart Van Assche                 else {
492*44704f69SBart Van Assche                     if (do_origin) {
493*44704f69SBart Van Assche                         if (1 == do_origin)
494*44704f69SBart Van Assche                             printf("Device clock %s\n",
495*44704f69SBart Van Assche                                    ts_origin_arr[0x7 & d_buff[2]]);
496*44704f69SBart Van Assche                         else if (2 == do_origin)
497*44704f69SBart Van Assche                             printf("%d\n", 0x7 & d_buff[2]);
498*44704f69SBart Van Assche                         else
499*44704f69SBart Van Assche                             printf("TIMESTAMP_ORIGIN=%d\n", 0x7 & d_buff[2]);
500*44704f69SBart Van Assche                     }
501*44704f69SBart Van Assche                     if (! no_timestamp) {
502*44704f69SBart Van Assche                         msecs = sg_get_unaligned_be48(d_buff + 4);
503*44704f69SBart Van Assche                         if (elapsed) {
504*44704f69SBart Van Assche                             int days = (int)(msecs / 1000 / 60 / 60 / 24);
505*44704f69SBart Van Assche                             int hours = (int)(msecs / 1000 / 60 / 60 % 24);
506*44704f69SBart Van Assche                             int mins = (int)(msecs / 1000 / 60 % 60);
507*44704f69SBart Van Assche                             int secs_in_min =(int)( msecs / 1000 % 60);
508*44704f69SBart Van Assche                             int rem_msecs = (int)(msecs % 1000);
509*44704f69SBart Van Assche 
510*44704f69SBart Van Assche                             if ((elapsed > 1) || (days > 0))
511*44704f69SBart Van Assche                                 printf("%d day%s ", days,
512*44704f69SBart Van Assche                                        ((1 == days) ? "" : "s"));
513*44704f69SBart Van Assche                             printf("%02d:%02d:%02d.%03d\n", hours, mins,
514*44704f69SBart Van Assche                                    secs_in_min, rem_msecs);
515*44704f69SBart Van Assche                         } else
516*44704f69SBart Van Assche                             printf("%" PRIu64 "\n", do_srep ?
517*44704f69SBart Van Assche                                                     (msecs / 1000) : msecs);
518*44704f69SBart Van Assche                     }
519*44704f69SBart Van Assche                 }
520*44704f69SBart Van Assche             }
521*44704f69SBart Van Assche         }
522*44704f69SBart Van Assche     }
523*44704f69SBart Van Assche     ret = res;
524*44704f69SBart Van Assche     if (res) {
525*44704f69SBart Van Assche         if (SG_LIB_CAT_INVALID_OP == res)
526*44704f69SBart Van Assche             pr2serr("%s command not supported\n", cmd_name);
527*44704f69SBart Van Assche         else {
528*44704f69SBart Van Assche             char b[80];
529*44704f69SBart Van Assche 
530*44704f69SBart Van Assche             sg_get_category_sense_str(res, sizeof(b), b, verbose);
531*44704f69SBart Van Assche             pr2serr("%s command: %s\n", cmd_name, b);
532*44704f69SBart Van Assche         }
533*44704f69SBart Van Assche     }
534*44704f69SBart Van Assche 
535*44704f69SBart Van Assche fini:
536*44704f69SBart Van Assche     if (sg_fd >= 0) {
537*44704f69SBart Van Assche         res = sg_cmds_close_device(sg_fd);
538*44704f69SBart Van Assche         if (res < 0) {
539*44704f69SBart Van Assche             pr2serr("close error: %s\n", safe_strerror(-res));
540*44704f69SBart Van Assche             if (0 == ret)
541*44704f69SBart Van Assche                 ret = sg_convert_errno(-res);
542*44704f69SBart Van Assche         }
543*44704f69SBart Van Assche     }
544*44704f69SBart Van Assche     if (0 == verbose) {
545*44704f69SBart Van Assche         if (! sg_if_can2stderr("sg_timestamp failed: ", ret))
546*44704f69SBart Van Assche             pr2serr("Some error occurred, try again with '-v' "
547*44704f69SBart Van Assche                     "or '-vv' for more information\n");
548*44704f69SBart Van Assche     }
549*44704f69SBart Van Assche     return (ret >= 0) ? ret : SG_LIB_CAT_OTHER;
550*44704f69SBart Van Assche }
551